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本 书 在 介绍 分 析 双 足 步行 机 器 人 的 发 展 动态 和 相关 理论 、 技 术 的 基础 
上 ， 着 重 通过 实验 操作 的 方法 向 读者 讲述 双 足 步行 机 器 人 的 制作 技术 。 在 
介绍 双 足 步行 机 器 人 概况 、 理 论 与 方法 、 相 关 技 术 、 实 验 平台 、 动 作 生 成 
器 、 情 感化 步 态 等 内 容 之 后 ， 针 对 双 足 步行 机 器 人 设计 了 12 个 标准 实验 ， 
这 些 实验 都 可 以 在 基于 作者 自主 研究 开发 的 双 足 步行 机 融 人 平台 上 实际 运 
行 ， 并 给 出 了 所 有 的 参考 答案 ， 以 给 读者 。 

本 书 可 以 作为 大 学 本 科 及 专科 学 生 、 职 业 技术 类 学 生 和 中 学 师 生 的 机 
器 人 实验 教学 参考 书 ， 也 适宜 从 事 计 算 机 、 机 械 电 子 工 程 、 自 动 化 、 智 能 
科学 、 数 字 娱 乐 的 科技 人 员 阅 读 和 研究 。 
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智能 制造 与 装备 制造 业 转型 升级 的 重要 技术 基础 与 应 用 领域 之 一 是 机 器 人 科学 与 技术 ， 
而 双 足 步行 机 器 人 又 代表 着 机 器 人 研究 应 用 领域 的 最 高 水 平 ， 是 青少年 学 习 掌 握 机 器 人 技术 
的 重要 途径 和 手段 ， 主 要 涉及 人 工 智能 、 计 算 机 硬件 制作 与 软件 控制 、 先 进 传感器 技术 等 。 
如 何 更 好 地 让 青少年 学 习 掌 握 这 门 技 术 ， 尤 其 是 通过 实验 制作 的 方法 ， 由 浅 入 深 地 向 读者 传 
授 双 足 步 行 机 器 人 技术 ， 是 我 们 撰写 这 本 书 的 最 终 目的 。 

本 书 以 大 学 本 科 和 专科 学 生 、 职 业 技术 类 学 生 和 中 学 师 生 为 主要 读者 对 象 ， 详 细 介 绍 双 
足 步行 机 器 人 的 制作 技术 与 方法 。 全 书 共 分 为 7 章 。 第 1 章 主要 介绍 双 足 步行 机 器 人 的 发 展 
过 程 和 国内 外 研究 动态 ; 第 2 章 介 绍 双 足 步行 机 器 人 的 基础 理论 和 方法 ; 第 3 章 介绍 双 足 步 
行 机 器 人 的 相关 技术 ; 第 4 章 介 绍 双 足 步行 机 器 人 的 实验 平台 ; 第 5 章 介绍 双 足 步行 机 器 人 
的 行为 生成 技术 ; 第 6 章 介 绍 双 足 机 器 人 情感 化 步 态 ; 第 7 章 介 绍 双 足 步行 机 器 人 的 12 个 
典型 实验 ， 并 给 出 其 参考 答案 。 
本 书 由 解 仑 、 王 志良 、 李 敏 嘉 编著 ， 制 定 主要 内 容 、 划 分 章节 和 统 稿 。 其 中 第 7 章 的 
12 个 实验 都 可 以 在 基于 作者 研究 开发 的 双 足 步行 机 器 人 平台 上 进行 实际 运行 ， 读 者 只 要 具 
备 我 们 的 这 种 环境 ， 按 照 书 中 的 指引 ， 就 可 以 自己 学 习 、 动 手 做 实验 ， 最 终 真正 掌握 双 足 步 
行 机 器 人 的 制作 技术 与 方法 。 这 是 本 书 的 特色 所 在 。 
本 书 的 出 版 得 到 了 机 械 工业 出 版 社 的 大 力 支持 ， 在 此 表示 诚 垄 的 感谢 ， 同 时 感谢 国家 自 
然 科学 基金 (61672093, 61432004) 和 国家 重点 研发 计划 重点 专项 课题 (2016YFB1001404 ) 
的 支持 。 作 者 可 以 免费 提供 书 中 相关 实验 的 电子 文档 及 程序 。 作 者 的 电子 信箱 E-mail: 
jiqiren _ ustb@ sohu. com, y£: 010-62332641, 

由 于 作者 的 水 平 有 限 ， 书 中 肯定 有 不 少 的 缺点 和 政 漏 之 处 ， 冤 请 读者 批评 指正 。 
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1.1 机 器 人 概述 


1.1.1 机 器 人 发 展 史 


机 器 人 的 历史 源远流长 ， 早 在 我 国 的 西周 时 期 ， 一 名 叫做 优 师 的 能 工 巧 折 就 造就 了 一 个 
能 歌 善 舞 的 伶 人 ， 这 是 有 据 可 查 的 第 一 个 “机 器 人 ”。 在 1800 年 前 的 汉 朝 ， 张 衡 造 出 了 举 
世 闻 名 的 地 动 仪 和 计 里 鼓 车 。 在 三 国 时 期 的 诸 更 亮 发 明了 木 牛 流 马 ， 用 来 运送 粮草 。 在 国 
外 ， 公 元 前 2 世纪 亚历山大 时 期 ， 古 希腊 人 造就 出 了 “自动 机 ”一 一 以 空气 、 水 、 蒸 汽 压 
力 为 动力 的 会 动 的 有 雕像。 这些 都 可 以 看 做 是 广义 上 的 机 器 人 。 

美国 的 德 沃 尔 (George G. Devol) 设想 了 一 种 可 控制 的 机 械 手 ， 他 首先 突破 了 对 机 器 人 
的 传统 观点 ， 提 出 机 器 人 并 不 一 定 必 须 像 人 ， 但 是 必须 能 做 一 些 人 的 工作 。1954 年 ， 他 依 
据 这 一 想法 设计 制作 了 世界 上 第 一 台 机 器 人 实验 装置 ， 发 表 了 《适用 于 重复 作业 的 通用 性 
工业 机 器 人 》 一 文 ， 并 获得 了 美国 专利 。 

德 沃 尔 将 遥控 操纵 器 的 关节 型 连 杆 机 构 与 数控 机 床 的 伺服 轴 连 接 在 一 起 ， 预 定 的 机 械 手 
动作 一 经 编程 输入 后 ， 机 械 等 就 可 以 离开 人 的 辅助 而 独立 运行 。 这 种 机 器 人 也 可 以 接受 示 教 
而 完成 各 种 简单 任务 。 

1959 年 ， 英 格 伯 格 和 德 沃 尔 联 手 制 造 出 第 一 台 工 业 机 器 人 。 由 英 格 伯 格 负责 设计 机 器 
人 的 “ 手 ”“ 脚 ”“ 身 体 ”， 即 机 器 人 的 机 械 部 分 和 完成 操作 部 分 ;由 德 沃 尔 设计 机 器 人 的 
“头脑 ” “神经 系统 ” “肌肉 系统 ”， 即 机 器 人 的 控制 装置 和 驱动 装置 。 它 成 为 世界 上 第 一 台 
真正 的 实用 工业 机 器 人 。 

英 格 伯 格 在 大 学 攻读 伺服 理论 ， 这 是 一 种 研究 运动 机 构 如 何 才 能 更 好 地 跟踪 控制 信号 的 
理论 。 德 沃 尔 曾 于 1946 年 发 明了 一 种 系统 ， 可 以 “重演 ”所 记录 的 机 需 的 运动 。1954 年 ， 
德 沃 尔 又 获得 可 编程 机 械 手 专利 ， 这 种 机 械 手 臂 按 程序 进行 工作 ， 可 以 根据 不 同 的 工作 需要 
编制 不 同 的 程序 ， 因 此 具有 通用 性 和 灵活 性 ， 英 格 伯 格 和 德 沃 尔 都 在 研究 机 器 人 ， 他 们 认为 
汽车 工业 最 适 于 用 机 器 人 王 活 ， 因 为 汽车 工业 是 用 重型 机 器 进行 工作 的 ， 生 产 过 程 较 为 固 
定 。 

这 种 机 器 人 外 形 有 点 像 坦 克 炮 塔 ， 基 座 上 有 一 个 大 机 械 臂 ， 大 臂 可 绕 轴 在 基 座 上 转动 ， 
大 辟 上 又 伸 出 一 个 小 机 械 辟 ， 它 相对 大 辟 可 以 伸 出 或 缩 回 。 小 辟 顶 有 一 个 腕 子 ， 可 绕 小 辟 转 
动 ， 进 行 傅 仰 和 侧 播 。 腕 子 前 头 是 手 ， 即 操作 器 。 这 个 机 器 人 的 功能 和 人 手臂 功能 相似 ， 如 
图 1-1 所 示 。 

这 是 世界 上 第 一 台 真 正 的 实用 工业 机 器 人 。 此 后 英 格 伯 格 和 德 沃 尔 成 立 了 “ Unimation” 
公司 ,兴办 了 世界 上 第 一 家 机 器 人 制造 工厂 。 第 一 批 工业 机 器 人 被 称 为 “ 尤 尼 梅 特 (UNI- 
MATE)”， 意 思 是 “万 能 自动 ”。 他 们 因此 被 称 为 机 器 人 之 父 。1962 年 美国 机 械 与 铸造 公司 
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也 制造 出 工业 机 器 人 ， 称 为 “ 沃 尔 萨 特 兰 (VERSTRAN)”， 意 思 是 “万 能 搬 动 "。“ 尤 尼 梅 
特 ” 和 “ 沃 尔 萨 特 兰 ”就 成 为 世界 上 最 早 的 、 至 今 仍 在 使 用 的 工业 机 器 人 。 


PPS ro E 


mumis! 


du - z y 


图 1-1 世界 上 第 一 台 工业 机 器 人 “ 尤 尼 梅 特 ” 正 在 生产 线 上 工作 


英 格 伯 格 和 德 沃 尔 制造 的 工业 机 器 人 是 第 一 代 机 器 人 ， 属 于 示 教 再 现 型 ， 即 人 手 把 着 机 
械 手 ， 把 应 当 完 成 的 任务 做 一 遍 ， 或 者 人 用 “ 示 教 控制 盒 ” 发 出 指令 ， 让 机 器 人 的 机 械 手 
臂 运 动 ， 一 步 步 完 成 它 应 当 完 成 的 各 个 动作 。 

1967 年 日 本 川崎 重工 公司 从 美国 购买 了 机 器 人 的 生产 许可 证 ， 日 本 从 此 开始 了 对 机 天 
人 制造 和 开发 的 热潮 。 

20 世纪 80 年 代 ， 计 算 机 技术 推动 机 器 人 技术 的 发 展 达到 了 新 的 水 平 。 上 到 宇宙 飞船 ， 
下 至 海洋 开发 都 采用 了 机 器 人 作业 。 机 器 人 技术 已 成 为 高 科技 应 用 领域 中 的 重要 组 成 部 分 。 

第 二 代 是 有 感觉 的 机 器 人 ， 它 们 对 外 界 环境 有 一 定 感知 能 力 ， 并 具有 听觉 、 视 觉 、 触 觉 
等 功能 。 机 器 人 工作 时 ， 根 据 感觉 器 官 〈 传 感 器 ) 获得 的 信息 ， 灵 活 调整 自己 的 工作 状态 ， 
保证 在 适应 环境 的 情况 下 完成 工作 。 如 : 有 触觉 的 机 械 手 可 轻松 自如 地 抓 取 鸡蛋 ， 上 共有 嗅觉 
的 机 器 人 能 分 辨 出 不 同 饮 料 和 酒 类 。 

第 三 代 机 天 人 是 智能 机 器 人 ， 它 不 仅 具 有 感觉 能 力 ， 而 且 还 具有 独立 判断 和 行动 的 能 
力 ， 并 具有 记忆 、 推 理 和 决策 的 能 力 ， 因 而 能 够 完成 更 加 复杂 的 动作 。 中 央 计 算 机 控制 手臂 
和 行走 装置 ， 使 机 器 人 的 手 完成 作业 ， 脚 完成 移动 ， 机 器 人 能 够 用 自然 语言 与 人 对 话 。 智 能 
机 需 人 的 “智能 ”特征 就 在 于 它 具 有 与 外 部 世界 一 一 对 象 、 环 境 和 人 相 适 应 、 相 协调 的 工 
作 机 能 。 从 控制 方式 看 ， 智 能 机 器 人 不 同 于 工业 机 融 人 的 “ 示 教 、 再 现 ”， 不 同 于 遥控 机 天 
人 的 “ 主 一 从 操纵 ”， 而 是 以 一 种 “ 认 知 一 适应 ”的 方式 自律 地 进行 操作 。 

智能 机 器 人 在 发 生 故 障 时 ， 通 过 自 诊 断 装置 能 自 诊 断 出 故障 部 位 ， 并 能 自修 复 。 今天， 
智能 机 器 人 的 应 用 范围 大 大 地 扩展 了 ， 除 工农 业 生 产 外 ， 机 器 人 还 应 用 到 各 行 各 业 ， 机 器 人 
已 具备 了 人 类 的 特点 。 机 器 人 向 着 智能 化 、 拟 人 化 方向 发 展 的 道路 是 没有 止境 的 。 
1. 


1.2 ”机 器 人 的 分 类 


机 融 人 按 不 同 的 分 类 方式 可 分 为 很 多 种 ， 如 按 应 用 环境 可 分 为 工业 机 器 人 和 特种 机 天 
As 按 功能 可 分 为 操作 型 机 器 人 、 程 控 型 机 咒 人 、 示 教 至 现 型 机 器 人 、 数 控 型 机 器 人 、 感 觉 
控制 型 机 器 人 、 适 应 控制 型 机 器 人 、 学 习 控制 型 机 器 人 和 智能 机 器 人 等 。 
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关于 机 器 人 如 何 分 类 ， 国 际 上 没有 制定 统一 的 标准 ， 有 的 按 功能 分 ， 有 的 按 负 载重 量 
分 ， 有 的 按 控制 方式 分 ， 有 的 按 自 由 度 分 ， 有 的 按 绪 构 分 ， 有 的 按 应 用 环境 分 。 我 国 的 机 器 
人 专家 从 应 用 环境 出 发 ， 将 机 器 人 分 为 两 大 类 : 工业 机 器 人 和 特种 机 器 人 。 所 谓 工业 机 器 人 
就 是 面向 工业 领域 的 多 关节 机 械 手 或 多 自由 度 机 器 人 。 而 特种 机 器 人 则 是 除 工 业 机 器 人 之 外 
的 、 用 于 非 制造 业 并 服务 于 人 类 的 各 种 先进 机 器 人 。 包 括 服务 机 器 人 、 水 下 机 器 人 、 娱 乐 机 
需 人 、 和 军用 机 咒 人 、 农 业 机 器 人 、 探 索 机 器 人 等 。 在 特种 机 吉 人 中 ， 有 些 分 支 发 展 很 快 ， 有 
独立 成 体系 的 趋势 ， 如 服务 机 器 人 、 水 下 机 器 人 、 盏 用 机 器 人 、 操 作 机 器 人 等 。 目 前 ， 国 际 
上 的 机 器 人 学 者 ， 从 应 用 环境 出 发 将 机 器 人 也 分 为 两 类 : 制造 环境 下 的 工业 机 器 人 和 非 制造 
环境 下 的 服务 性 类 人 机 器 人 ， 这 和 我 国 的 分 类 是 一 致 的 。 

1. 按照 机 器 人 从 低级 到 高 级 的 发 展 程度 分 类 

(1) 第 一 代 机 器 人 “第 一 代 机 需 人 主要 指 只 能 以 “ 示 教 一 再 现 ”方式 工 作 的 工业 机 需 
人 人。 目前 国际 上 商品 化 、 实 用 化 的 机 器 人 大 都 属于 第 一 代 机 器 人 。 

(2) 第 二 代 机 器 人 “第 二 代 机 器 人 是 智能 机 句 人 。 它 具有 多 种 感知 功能 ， 可 进行 复杂 
的 逻辑 思维 、 判 断 决 策 ， 在 作业 环境 中 独立 行动 。 

(3) 第 三 代 机 器 人 第 三 代 机 器 人 是 未 来 机 器 人 。 

2. 按照 开发 内 容 和 目的 分 类 

按照 开发 内 容 和 目的 分 类 基本 上 有 3 类 机 器 人 : 中 工业 机 器 人 (Industrial Robot) ; OH 
纵 型 机 器 人 (Teleoperator Robot) ; @) 智 能 机 器 人 (Intelligent Robot) 。 

3. 按照 机 器 人 的 结构 形式 分 类 

机 器 人 可 分 为 关节 型 机 器 人 和 非 关节 型 机 器 人 。 其 中 关节 型 机 器 人 的 机 械 本 体 部 分 一 般 
为 由 各 种 关节 串 接 起 若干 连 杆 组 成 的 开 链 式 机 构 。 


1.1.3 机 器 人 的 定义 与 三 定律 


在 科学 界 ， 科 学 家 会 给 每 一 个 科技 术语 一 个 明确 的 定义 ， 机 器 人 间 志 已 有 儿 十 年 了 ,但 
是 对 于 机 器 人 的 定义 仍然 是 仁者 见 仁 ， 智 者 见 智 ， 没 有 一 个 统一 的 意见 。 原 因 之 一 是 机 器 人 
还 在 发 展 ， 新 的 机 型 、 新 的 功能 不 断 诵 现 。 根 本 原因 主要 是 因为 机 器 人 涉及 了 人 的 概念 ,成 
为 一 个 难以 回答 的 哲学 问题 。 

1886 年 法 国 作 家 利 尔 亚 在 他 的 小 说 《未 来 的 夏娃 》 中 将 外 表 像 人 的 机 顺 起 名 为 “ 安 德 
罗 丁 ”。1920 年 捷克 作家 卡 雷 尔 ' 卡 佩 克 发 表 了 科幻 剧本 《 罗 了 萨 姆 德 万 能 机 器 人 》。 剧 本 中 ， 
卡 佩 克 把 捷克 语 “Robota” 写 成 了 “Robot”， 该 剧 预 告 了 机 器 人 的 发 展 对 人 类 社会 的 悲剧 性 
影响 ， 引 起 了 大 家 的 广泛 关注 ， 被 当成 了 机 器 人 一 词 的 起 源 。 

在 1967 年 日 本 召开 了 第 一 届 机 器 人 学 术 会 议 上 ， 人 们 提出 了 两 个 有 代表 性 的 定义 。 一 
个 是 森 政 弘 与 合 田 周 平 提出 的 :“ 机 器 人 是 一 种 具有 移动 性 、 个 体 性 、 智 能 性 、 通 用 性 、 半 
机 器 半 人 性 、 上 自动 性 、 奴 隶 性 等 7 个 特征 的 柔性 机 器 ” 。 从 这 一 定义 出 发 ， 森 政 弘 又 提出 了 
自动 性 、 智 能 性 、 个 体 性 、 半 机 器 半 人 行 、 作 业 性 、 通 用 性 、 信 息 性 、 柔 性、 有 限 性 、 移 动 
性 等 10 个 特性 来 表示 机 器 人 的 形象 ， 男 一 个 是 加 苹 一 郎 提出 的 具有 如 下 3 个 条 件 的 机 器 称 
为 机 器 人 : 

具有 脑 、 手 、 脚 等 三 要 素 的 个 体 ; 

具有 非 接触 传感器 〈 用 有 眼 、 耳 接受 远方 信息 ) 和 接触 传感器 ; 


p 
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1987 年 国际 标准 化 组 织 ISO 对 工业 机 絮 人 进行 了 定义 :“ 工 业 机 右 人 是 一 种 具有 自动 控 
制 的 操作 和 移动 功能 ， 能 完成 各 种 作业 的 可 编程 操作 机 '” 。” 

我 国 科学 家 对 机 器 人 的 定义 是 :“ 机 上 咒 人 是 一 种 自动 化 的 机 器 ， 所 不 同 的 是 这 种 机 顺 具 
备 一 些 与 人 或 生物 相似 的 智能 能 力 ， 如 感知 能 力 、 规 划 能 力 、 动 作 能 力 和 协同 能 力 ， 是 一 种 
具有 高 度 灵 活性 的 自动 化 机 器 。” 在 研究 和 开发 未 知 以 及 不 确定 环境 下 作业 的 机 器 人 的 过 程 
中 ， 人 们 逐步 认识 到 机 融 人 技术 的 本 质 是 感知 、 决 策 、 行 动 和 交互 技术 的 结合 。 

现代 的 机 器 人 技术 在 不 断 地 发 展 着 ， 随 着 机 器 人 的 进化 和 人 工 智 能 的 进步 ， 这 些 定义 都 
会 得 到 不 断 的 完善 和 发 展 ， 甚 至 有 可 能 重新 对 机 带 人 进行 加 新 的 定义 。 

KREWE « 阿 西 莫 夫 是 一 位 化 学 家 和 有 着 世界 声望 的 科普 作家 ， 他 对 科幻 小 说 的 最 
大 贡献 之 一 是 “发 明 ” 了 “机 器 人 三 定律 "。 三 定律 从 逻辑 学 的 角度 对 科幻 小 说 中 盗 意 万 为 
的 机 顺 人 进行 了 行为 规范 ， 对 今天 的 机 器 人 研制 也 有 着 重要 的 指导 意义 。 

机 器 人 学 三 定律 : 

第 一 定律 一 一 机 器 人 不 得 伤害 人 ， 也 不 得 见 人 受到 伤害 而 袖手旁观 。 

第 二 定律 一 一 机 器 人 应 服从 人 的 一 切 命令 ， 但 不 得 违反 第 一 定律 。 

第 三 定律 一 一 机 咒 人 应 保护 自身 的 安全 ， 但 不 得 违反 第 一 、 第 二 定律 。 


1.1.4. 机 器 人 技术 发 展 动向 


当前 和 今后 的 机 器 人 技术 正 逐 渐 向 着 具有 行走 能 力 、 对 环境 的 自主 性 强 、 具 有 多 种 感觉 
(比如 可 以 感觉 形状 、 重 量 、 硬 度 、 温 度 和 湿度 等 ) 能 力 的 方向 发 展 。 

机 器 人 也 正在 逐渐 具有 智能 。 美 国 贝 尔 科 尔 公 司 已 成 功 地 将 神经 网 络 装配 在 芯片 上 ， 其 
智能 分 析 速 度 比 普通 计算 机 要 快 数 千 倍 ， 能 更 好 地 完成 识别 语言 和 图 像 处 理 等 的 工作 。 

目前 ， 对 机 器 人 技术 的 发 展 有 最 重要 影响 的 国家 是 美国 和 日 本 。 美 国 在 机 器 人 技术 的 综 
合 性 水 平 上 仍 处 于 领先 地 位 ， 日 本 生产 的 机 器 人 数量 和 种 类 则 居 世 界 首位 。 

我 国 发 展 机 器 人 技术 起 步 于 20 世纪 70 年 代 末 。1995 年 9 H, 6000m 水 下 机 器 人 试验 成 
功 。 近 年 来 ， 在 步行 机 器 人 、 精 密 装 配 机 器 人 及 多 自由 度 关 节 型 机 器 人 研制 等 前 沿 领 域内 逐 
步 缩短 了 与 世界 水 平 的 差距 。 

机 器 人 技术 经 数 十 年 的 发 展 ， 现 已 形成 了 一 门 综合 性 学 科 一 一 机 右 人 学 (Robotics ) 。 
机 器 人 学 包括 基础 研究 和 应 用 研究 两 方面 内 容 ， 主 要 研究 领域 有 : 中 机 械 手 设计 ; @ 机 器 人 
运动 党、 动力 学 和 控制 ，@@ 轨 迹 设计 和 规划 ; 介 机 器 人 传感器 ; 名 机 器 人 视觉 @ 机 器 人 控 
制 语言 和 离线 编程 ; (2 机 器 人 本 体 结构 系统 ; @ 机 器 智能 等 。 


1.1.5 类 人 机 器 人 技术 


现 阶段 ， 机 器 人 的 研究 应 用 领域 不 断 拓宽 ， 其 中 类 人 机 融 人 《也 叫 仿 人 机 带 人 ) 的 研 
究 和 应 用 尤其 受到 普遍 关注 ， 并 成 为 智能 机 器 人 领域 中 最 活跃 的 研究 热点 之 一 。 

最 早 系统 地 研究 人 类 和 动物 运动 原理 的 是 美国 摄影 师 爱 德 华 得 . 麦 布 里 奇 (Eadweard 
Muybridge) ， 他 发 明了 电影 用 的 独特 摄像 机 ， 即 一 组 电动 式 触 发 照相 机 ， 并 在 1877 年 成 功 
地 拍摄 了 许多 四 足 动物 步行 和 奔跑 的 连续 照片 。 后 来 ， 这 种 采用 摄像 机 的 方法 又 被 乔治 ' 德 
米 尼 (Georges Demeny) 用 来 研究 人 类 的 步行 运动 。 
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真正 全 面 、 系 统 地 开展 类 人 机 器 人 的 研究 是 始 于 20 世纪 60 年 代 。 而 类 人 机 器 人 的 重要 
基础 研究 内 容 ， 就 是 双 足 步行 机 器 人 技术 。 氨 今 ， 不 仅 形 成 了 双 足 步行 机 器 人 一 整套 较为 完 
善 的 理论 体系 ， 而 且 在 一 些 国 家 ， 如 日 本 、 美 国 和 俄罗斯 等 都 已 研制 成 功 了 能 静态 或 动态 步 
行 的 双 足 步行 机 器 人 样机 。 

早 在 20 世纪 50 年 代 中 期 ， 美国 通用 电气 公司 就 制造 了 一 台 名 为 “Hardiman” 的 步行 
Jg, 但 当时 的 驱动 和 伺服 控制 技术 显然 还 不 足以 使 Hardiman 进入 实用 化 阶段 。 

1968 年 ， 英 国 的 Mosher R 试制 了 一 台 名 为 “Rig” 的 操纵 型 双 足 步行 机 器 人 ， 它 只 有 
躁 和 髋 两 个 关节 ， 操 作者 靠 力 反馈 感觉 来 保持 机 器 人 平衡 ， 这 种 主 从 式 的 机 械 装置 可 算是 双 
足 步行 机 构 的 雏形 。 

真正 的 双 足 步行 机 器 人 是 Kato 在 1971 年 试制 的 Wap3 ， 它 最 大 步 幅 为 13mm， 周 期 为 
45s, Wap3 的 研制 成 功 ， 揭 开 了 双 足 步行 机 器 人 的 研究 序幕 。 

1984 年 ， 日 本 的 加 藤 实 验 室 又 推出 了 WL-9DR 双 足 步行 机 器 人 。1984 年 ， 加 芯 在 以 前 
的 研究 基础 上 采用 了 躁 关节 力 抢 控制 ， 使 WL-IORD 双 足 步行 机 器 人 实现 了 平稳 的 动态 步 
行 。1986 ^E, Juge ud TRHA 8 个 自由 度 的 WL-12R 双 足 步行 机 器 人 。 

1971 ~ 1986 年 间 ， 和 牛津 大 学 的 Witt 等 人 曾 制造 和 完善 了 一 个 双 足 步行 机 器 人 ， 在 平地 
上 走 得 非常 好 ， 步 速 为 0.23m/s， 功率 消耗 约 为 4W。 

日 本 的 本 Furusho 人 研制 了 两 个 系列 的 能 够 动态 步行 的 双 足 步行 机 构 ， 从 1981 年 开始 ， 先 
后 研制 了 Kenkyaku-1 、Kenkyaku-2 、BLR-G1 和 BLR-G2 双 足 步行 机 器 人 。 

日 本 的 Kajita 是 日 本 另 一 步行 机 器 人 研究 者 。1990 年 ， 他 研制 成 功 了 一 台 五 连 杆 平面 
型 双 足 步行 机 器 人 ， 实 现 了 在 不 平地 面 上 的 稳定 动态 步行 。 

1986 年 ， 美 籍 华人 郑 元 芳 博士 分 别 研 制 成 功 SD-1 双 足 步行 机 器 人 和 SD-2 型 双 足 步行 
机 器 人 ， 成 功 地 实现 了 平地 上 的 前 进 、 后 退 以 及 左 、 右 侧 行 和 动态 步行 。1990 年 ， 他 首次 
提出 了 使 双 足 步行 机 器 人 能 够 走 和 斜坡 的 控制 方案 ， 并 应 用 于 SD-2 双 是 步行 机 器 人 中 获得 成 
功 实现 。 

1985 年 ， 美 国 的 Hodgins 和 Raibert 等 人 研制 了 一 个 用 来 进行 奔跑 运动 和 表演 体操 动作 
的 平面 型 双 足 步行 机 器 人 。1986 年 ， 他 们 用 这 个 机 器 人 进行 奔跑 实验 ， 着 重 研究 奔跑 过 程 
中 出 现 的 弹射 飞行 状态 。1988 年 和 1990 年 ， 他 们 又 用 这 个 机 器 人 进行 了 翻 筋 斗 动作 实验 。 
Hodgins 和 Raibert 研究 这 两 种 运动 是 因为 它们 含有 丰富 的 动力 学 内 容 ， 尤 其 是 两 者 都 具有 弹 
射 飞行 状态 。 


1986 年 ， 日 本 本 田 公 司 制 定 了 第 一 个 f: | 
研制 拟人 机 器 人 的 计划 ， 并 于 1996 年 11 月 "Nr i 
展示 了 一 个 有 两 腿 两 辟 的 拟人 机 器 人 P2。 i -BB 
本 田 公司 在 1997 年 10 月 又 推出 了 世界 领先 | 


的 P3 机 器 人 ， 如 图 1-2 所 示 。 LA d ^d p | 
我 国 从 20 世纪 80 年 代 中 期 才 开始 研究 E " 
类 人 机 器 人 ， 主 要 研究 单位 是 国防 科技 大 学 上 B | 
和 哈尔滨 工业 大 学 。 | 
哈尔滨 工业 大 学 于 1989 年 研制 了 一 台 — 
类 人 机 器 人 人， 重量 为 70kg， 高 度 为 110cm， 图 1-2 ”本田 P3 双 足 步行 机 器 人 外 观 
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有 10 个 自由 度 ， 可 以 实现 平地 上 的 前 进 、 左 右 侧 行 及 上 下 楼 梯 的 运动 ， 步 幅 可 达 45cm， 步 
速 10 步 /s， 为 静态 步行 。 

国防 科技 大 学 在 1988 年 成 功 研制 了 一 
台 KDW- 工 平面 型 、6 自由 度 的 双 足 步行 机 
器 人 ， 能 实现 前 进 、 后 退 和 上 下 楼 梯 。1989 
年 ， 他 们 又 成 功 研制 了 一 台 KDW- 卫 空间 运 
动 型 的 双 足 步行 机 器 人 人， 实现 了 准 动态 步 
行 ，1995 年 实现 了 动态 步行 。2000 年 11 月 
29 日 ， 他 们 成 功 研制 出 新 型 双 足 步行 机 器 
人 。 不 仅 能 平地 静态 步行 ， 而 且 能 快速 自如 
地 动态 步行 ， 既 能 在 已 知 环境 中 步行 ， 也 可 
在 小 偏差 、 不 确定 环境 下 行走 ， 实 现 了 多 项 
关键 技术 突破 ， 如 图 1-3 所 示 。 

世界 著名 机 器 人 学 专家 、 日 本 早稻 田 大 
学 的 加 芯 一 郎 教授 门 说 过 : “机 器 人 应 当 具 
有 的 最 大 特征 之 一 是 步行 功能 。” 步行 是 人 
与 大 多 数 生物 所 具有 的 移动 方式 ， 其 形式 主 
要 有 双 足 步行 、 四 足 步 行 和 六 足 步 行 。 其 中 
双 足 步行 是 步行 方式 中 自动 化 程度 最 高 、 最 为 复杂 的 系统 ， 同 时 双 足 步行 机 器 人 也 有 着 其 他 
机 器 人 不 可 比拟 的 优点 : 具有 适应 各 种 地 面 和 较 强 的 逾越 障碍 的 能 力 ; 步行 机 器 人 的 能 耗 通 
常 低 于 轮 式 和 履带 式 机 器 人 ， 即 能 耗 较 小 。 随 着 对 双 足 步行 机 器 人 的 研究 不 断 深 入 ， 无 论 是 
影视 、 科 幻 作 品 还 是 人 们 对 机 器 人 的 第 一 意识 ， 都 把 像 人 一 样 的 机 器 人 作为 机 器 人 研究 的 最 
高 境界 。 机 器 人 的 研究 者 也 一 直 把 实现 机 器 人 的 拟人 行为 作为 梦 赎 以 求 的 目标 。 拟 人 机 器 人 
是 一 种 智能 的 、 机 动 的 、 能 满足 用 户 多 种 需求 的 新 型 机 器 人 ， 这 种 机 器 人 具有 人 的 外 形 和 基 
本 功能 ， 易 于 与 人 共处 ， 易 于 适应 多 变 的 活动 环境 。20 世纪 90 年 代 前 后 ， 双 足 机 器 人 从 一 
般 性 的 拟人 腿 部 行走 上 升 到 全 方位 的 拟人 机 器 人 研究 。 拟 人 机 器 人 除了 腿 部 的 行走 功能 外 ， 
还 包括 手 、 腰 和 头 的 功能 ， 自 由 度 比 双 足 步行 机 器 人 成 倍 地 增加 ， 与 此 同时 也 带 来 了 控制 规 
划 、 动 力学 、 运 动 学 上 更 为 复杂 的 问题 。 此 外 ， 还 有 电荷 耦合 吉 件 (CCD ) KRAM, 
音 处 理 以 及 一 系列 传 感 信 号 的 处 理 。 拟 人 机 器 人 相对 于 双 足 机 器 人 的 研究 ， 更 为 类 似 人 类 。 
拟人 机 器 人 是 由 仿生 学 、 机 械 工 程 学 和 控制 工程 学 等 多 学 科 相 互 融 合 而 成 的 综合 性 学 科 。 

研究 拟人 机 器 人 的 科学 意义 主要 在 于 : 

第 一 ， 拟 人 机 器 人 的 研究 模型 为 控制 理论 应 用 及 动力 学 问题 的 研究 提供 了 广阔 的 天 地 。 
拟人 机 器 人 是 一 个 多 变量 、 强 耦合 、 非 线性 和 变 结构 的 复杂 动力 学 系统 ， 其 变 姿 态 结构 的 小 
稳定 性 及 产生 稳定 步行 运动 所 需要 解决 的 动态 平衡 问题 ， 对 于 控制 理论 及 动力 学 问题 的 研究 
来 说 ， 具 有 很 大 挑战 。 

第 二 ， 拟 人 机 器 人 作为 步行 机 器 人 的 一 种 形式 ， 是 提高 机 器 人 机 动 性 和 节省 能 源 的 一 条 
重要 途径 。 研 究 拟人 机 器 人 的 双 足 步行 运动 ， 揭 示 了 双 足 类 步行 运动 的 机 理 及 控制 规律 ， 研 
制 一 种 连续 稳定 步行 的 拟人 步行 机 器 人 ， 可 为 机 器 人 操作 提供 灵活 的 操作 平台 ， 使 其 能 够 在 
恶劣 的 条 件 下 工作 。 因 此 拟人 机 器 人 有 着 潜在 的 广阔 应 用 前 景 。 


图 1.3 ”国防 科技 大 学 研制 的 双 足 步行 机 器 人 
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拟人 机 器 人 研究 集 机 械 、 电 子 、 计 算 机 、 材 料 、 传 感 器 、 控 制 技术 、 通 信 、 人 工 智能 、 
人 工 心理 等 多 门 科学 于 一 体 ， 代 表 着 一 个 国家 的 高 科技 发 展 水 平 。 从 机 器 人 技术 和 人 工 智 能 
的 研究 现状 来 看 ， 要 完全 实现 高 智能 、 高 灵活 性 的 拟人 机 器 人 还 有 很 长 的 路 要 走 ， 而 且 人 类 
对 自身 也 没有 彻底 了 解 ， 这 些 都 限制 了 拟人 机 器 人 的 发 展 。 


1.1.6 机 器 人 系统 理论 


1.1.6.1 机 械 系 统 

机 械 系 统 是 由 机 械 元 素 组 成 的 ， 它 可 以 是 自然 的 ， 也 可 以 是 人 造 的 。 后 者 是 我 们 要 研究 
的 对 象 。 机 器 人 的 机 械 系 统 由 以 下 几 个 子 系统 组 成 : 中 机 械 子 系统 ， 由 刚体 和 弹性 体 组 成 ; 
@) 传 感 系 统 ; QATAR Ohir; 人 信息 处 理 。 此 外 ， 子 系统 之 间 的 通信 是 通过 接口 进 
行 的 ， 接 口 的 基本 功能 是 把 从 一 个 部 分 传 到 男 一 个 部 分 的 信息 解码 。 图 14 是 典型 机 械 系 统 
的 框图 ， 系 统 的 输入 是 事先 确定 的 任务 ， 它 是 由 实时 或 离线 给 定 的 。 前 者 在 本 质 上 看 成 是 智 
能 的 ， 后 者 是 可 编程 序 的 机 械 。 机 器 人 的 机 械 系统 输出 是 通过 传感器 监测 的 实际 任务 (Ac- 
tual Task) 。 传 感 句 以 反馈 信号 的 形式 传递 作业 信息 并 与 事先 设 定 的 动作 相 比 较 ， 事 先 设 定 
的 任务 与 执行 动作 间 的 误差 反馈 给 控制 器 ， 然 后 合成 必要 的 校正 信号 。 在 机 器 人 控制 系统 
中 ， 通 过 人 来 构成 闭环 控制 的 称 为 遥控 机 器 人 (Telemanipulator) 。 遥 控 机 器 人 是 人 借助 于 复 
厅 的 传感器 和 显示 装置 进行 控制 的 机 械 系 统 ， 操 作者 也 就 成 了 图 14 所 示 框 图 中 的 一 个 中 心 
单元 ， 根 据 显 示 的 信息 ， 操 作者 对 校正 信号 调整 ， 以 完成 所 需要 完成 的 动作 。 

我 们 必须 明确 ， 研 究 机 器 人 机 械 系 统 ， 需 要 建立 起 一 套 运 动 的 表示 方法 。 我 们 用 独立 的 
杆 件 运动 组 合成 机 械 系统 ， 把 这 些 杆 件 看 成 刚体 。 一 般 刚体 的 运动 由 平 动 和 转动 组 成 ， 通 过 
一 个 坐标 系 和 矢量 代数 计算 距离 和 角度 ， 并 在 此 坐标 系 下 描述 矢量 ， 但 最 终 的 结果 与 我 们 所 
选择 的 坐标 系 无 关 。 最 终 得 到 的 数学 模型 就 是 我 们 要 找 的 机 械 系 统 运动 的 表示 方法 。 这 些 数 
学 表示 方法 一 般 包 括 : 线性 变换 、 刚 体 的 旋转 和 矩阵、 坐标 变换 和 齐 次 坐标 建立 、 校 正方 法 及 
各 种 方法 的 合成 等 。 以 上 各 种 方法 的 具体 概念 及 实现 方法 请 参见 相关 文献 。 
误差 位 置 和 


作业 描述 实际 动作 


图 1-4 机 器 人 机 械 系 统 框图 


1.1.6.2. 人 工 心理 

用 机 器 模拟 人 类 心理 行为 (情感 等 ) 一 直 为 人 们 所 追求 。 目 前 ， 用 机 器 模拟 人 类 心理 
行为 (情感 等 ) 的 相关 技术 研究 正在 形成 一 种 趋势 ， 尤 其 以 日 本 最 为 先进 。 近 几 年 来 ， 在 
日 本 科学 技术 界 流 行 “ 感 性 工学 (Kansei Engineering)” 的 新 术语 。 由 于 这 是 一 个 新 的 领 
域 ， 日 本 所 取得 的 成 果 都 是 初步 的 ， 有 许多 问题 骂 待 解决 。 比 如 ， 日 本 提出 的 “感性 工学 ” 
的 定义 不 清楚 (ME 10 多 种 定义 ) ， 其 研究 范围 只 是 对 准 人 类 心理 活动 的 一 个 方面 一 一 
“感性 ”。 王 志良 教授 于 1999 年 提出 了 一 个 全 新 的 概念 “人 工 心理 ”， 并 出 现在 国家 自然 科 
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学 基金 2000 年 度 项 目 指南 自动 化 学 科 中 。 其 与 人 工 智 能 的 关系 如 图 1-5 所 示 。 

人 工 心理 理论 ， 就 是 利用 信息 科学 手段 ， HE 
对 人 的 心理 活动 的 更 全 面 内 容 的 再 一 次 人 工 机 
器 〈 计 算 机 、 模 型 算法 ) 实现 一 一 人 工 心理 学 。 
尼 的 应 用 前 景 是 非常 广泛 的 ， 如 支持 开发 有 和 情 
感 、 意 识 和 智能 的 机 器 人 ; 真正 意义 上 的 拟人 
机 械 研 究 ; 使 控制 理论 更 接近 于 人 脑 的 控制 模 
式 。 我 们 知道 , 已 有 的 拟人 控制 理论 主要 就 是 
维 纳 的 “反馈 ”控制 论 和 人 工 智 能 ; 这 与 人 脑 
的 控制 模式 还 有 很 大 差别 ， 因 为 人 脑 控 制 模式 
是 : 感知 觉 + 情感 决定 行为 ; 而 现 有 的 控制 系 
统 决策 不 考虑 也 无 法 考虑 情感 的 因素 。 人 工 心 
理应 用 的 另 一 大 领域 是 符合 人 性 化 的 商品 设计 图 1-5 人 工 心理 与 人 工 智能 的 关系 
和 市 场 开 发 。 不 夸张 地 说 ， 人 工 心理 理论 是 人 工 智能 的 高 级 阶段 ， 是 自动 化 乃至 信息 科学 的 
全 新 研究 领域 ， 它 的 研究 将 会 大 大 促进 拟人 控制 理论 、 情 感 机 器 人 、 人 性 化 的 商品 设计 和 市 
场 开 发 等 方面 的 进展 ， 为 最 终 营 造 一 个 人 与 人 、 人 与 机 器 和 谐 的 社会 环境 作出 贡献 。 
1.1.6.3 智能 控制 
智能 控制 (Intelligent Control) 的 概念 由 傅 京 逊 于 1971 年 提出 ， 由 美国 的 萨 里 迪 斯 
(Sardis) 等 人 在 此 基础 上 于 1977 年 进一步 提出 了 一 种 智能 机 器 (Intelligent Machine) 的 统 
一 结构 框架 。 该 结构 现 已 被 控制 界 普遍 接受 ， 它 具有 递 阶 分 散 智能 与 精度 的 特点 ， 包 括 组织 
级 (Organization Level) 、 协 调 级 (Coordination Level) 和 执行 级 或 控制 级 ( Execution Lev- 
el) ， 且 各 层次 间 遵 循 精度 随 智能 降低 而 提高 (Increasing Precision with Decreasing Intelligence 
IPDI) 原则 。 
智能 控制 是 随 着 被 控 对 象 的 日 益 复 杂 ， 为 适应 其 对 环境 依赖 的 不 可 侵害 性 而 产生 的 。 作 
为 一 门 新 兴 的 学 科 ， 它 融合 了 包括 神经 生理 学 、 心 理学 、 运 筹 学、 控制 论 和 计算 机 科学 的 多 
学 科 思 想 和 技术 的 成 果 。 而 对 智能 控制 的 研究 ， 主 要 体现 在 对 基于 知识 系统 (Knowledge 
Based System, KBS), RANZ (Fuzzy Logic) 和 人 工 神经 网 络 (Artificial Neural Network ) 
的 研究 。 

PLA (Robotics) 是 一 门 高 度 综合 和 交叉 的 新 兴学 科 ， 它 涉及 的 领域 很 多 ， 诸 如 机 
械 、 电 气 、 工 艺 、 力 学 、 传 动 、 控 制 、 通 信 、 决 策 、 生 物 、 伦 理 等 诸多 方面 。 

1) 从 控制 角度 看 ， 其 中 最 主要 也 是 最 基本 的 是 机 器 人 的 运动 学 (Kinematies) 和 动力 
学 (Dynamics) 问题 及 相应 的 控制 策略 研究 。 

机 器 人 运动 学 包括 前 向 运动 学 (Forward Kinematics) 和 逆 运 动 学 (Inverse Kinematics) , 
或 分 别称 为 运动 学 的 正 问题 和 逆 问 题 。 其 中 ， 前 向 运动 学 研究 以 机 器 人 的 各 关节 参数 ( 广 
义 坐 标 ) 来 决定 终端 操作 器 (End-effector) 的 位 型 (Position and Orientation); 而 道 运动 学 
则 是 研究 由 期 望 的 终端 操作 咒 位 型 来 得 到 各 关节 变量 的 过 程 。 

机 絮 人 动力 学 问题 主要 包括 两 大 类 ， 即 运动 分 析 和 力 分 析 。 运 动 分 析 研 究 由 机 右 人 连 杆 
系 的 受 力 情况 (外 力 和 关节 驱动 力 ) 决定 各 关节 运动 状况 (位 置 、 速 度 和 加 速度 )， 进 而 通 
过 运动 学 方法 来 最 终 获 得 终端 操作 器 位 置 的 过 程 和 方法 ; 而 力 分 析 则 是 研究 由 期 望 的 机 器 人 
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各 连 杆 的 运动 (位移 、 速 度 和 加 速度 ) 得 到 需 施加 于 各 关节 处 的 驱动 力 或 力矩 的 方法 和 策 
WE. ， 即 我 们 通常 所 说 的 控制 综合 问题 。 

2) 从 智能 角度 看 ， 随 着 机 器 人 技术 的 迅速 发 展 和 自动 化 程序 的 进一步 提高 ， 对 机 器 人 
的 功能 也 提出 了 更 高 的 要 求 ， 特 别 是 需要 各 种 具有 不 同 程序 智能 的 机 器 人 。 智 能 机 器 人 已 在 
自主 系统 和 和 柔性 加 工 系统 中 日 益 得 到 广泛 的 应 用 。 自 主机 器 人 能 够 设 定 自 己 的 目标 ， 规 划 并 
执行 自己 的 动作 ， 使 自己 不 断 适 应 环境 的 变化 。 这 些 机 器 人 智能 程度 的 提高 ， 离 不 开 人 工 技 
术 的 发 展 ， 其 中 包括 人 工 心 理 、 人 工 智 能 、 情 感 计算 、 人 工 生命 等 。 
1.1.6.4 人 工 生命 

20 世纪 60 年代， 人 们 破译 了 遗传 密码 ，70 年 代 遗 传 工程 有 了 重大 突破 。 很 自然 ， 生 物 
学 研究 的 下 一 个 重要 目标 就 是 用 人 工 的 方法 合成 生命 。 然 而 ， 以 现 有 生命 物质 为 基础 合成 生 
命 似乎 前 景 并 不 乐观 。 那 么 ， 我 们 有 没有 其 他 办 法 创造 生命 呢 ? 计算 机 科学 的 发 展 为 我 们 提 
供 了 一 条 新 的 研究 思路 ， 即 我 们 可 以 尝试 在 计算 机 或 其 他 媒质 中 创造 出 新 形式 的 生命 。 这 就 
是 80 年 代 末 90 年 代 初 在 国际 上 兴起 的 一 个 新 的 研究 领域 一 一 人 工 生 命 。 人 工 生 命 概 念 一 提 
出 ， 吸 引 了 众多 学 者 参与 到 这 一 新 兴 的 研究 领域 中 。 

人 工 生命 是 一 项 抽象 地 提取 出 控制 生物 现象 的 基本 动态 原理 ， 并 且 通 过 物理 媒介 (如 
计算 机 ) 来 模拟 生命 系统 动态 发 展 过 程 的 研究 工作 。 它 涉及 众多 的 学 科 领 域 ， 如 生物 科学 、 
计算 机 科学 、 控 制 科 学 、 系 统 科学 、 机 器 人 科学 、 人 工 智能 等 。 该 项 学 科 的 建立 一 般 被 认为 
台 于 1987 年 在 美国 召开 的 第 一 次 人 工 生 命 研讨 会 。 

13 . 诺 伊 曼 也 是 人 工科 学 的 先驱 。20 世纪 40 年 代 和 50 年 代 ， 他 在 数字 计算 机 设计 和 
人 工 智能 领域 做 了 很 多 开创 性 的 工作 。 与 图 灵 一 样 ， 他 也 试图 用 计算 的 方法 揭示 出 生命 最 本 
质 的 方面 。 但 与 图 灵 关 注 生 物 的 形态 发 生 不 同 ， 他 则 试图 描述 生物 自我 繁殖 的 逻辑 形式 。 在 
发 现 DNA 和 遗传 密码 好 几 年 之 前 ， 他 已 认识 到 ， 任 何 自 我 繁殖 系统 的 遗传 物质 ， 无 论 是 自 
然 的 还 是 人 工 的 ， 都 必须 具有 两 个 不 同 的 基本 功能 : 一 方面 ， 它 必须 起 到 计算 机 程序 的 作 
用 ， 是 一 种 在 繁衍 下 一 代 过 程 中 能 够 运行 的 算法 ; 另 一 方面 ， 它 必须 起 到 被 劲 数据 的 作用 ， 
是 一 个 能 够 复制 和 传 到 下 一 代 的 描述 。 为 了 避免 当时 电子 管 计算 机 技术 的 限制 ， 他 提出 了 细 
胞 自动 机 的 设想 : 把 一 个 长 方形 平面 分 成 很 多 个 网 格 ， 每 一 个 格 点 表示 一 个 细胞 或 系统 的 基 
元 ， 每 一 个 细胞 都 是 一 个 很 简单 、 很 抽象 的 自动 机 ， 每 个 自动 机 每 次 处 于 一 种 状态 ， 下 一 次 
的 状态 是 由 它 周 围 细 胞 的 状态 和 它 自身 的 状态 以 及 事先 定义 好 的 一 组 简单 规则 决定 的 。 
冯 ，… 诺 人 很 曼 证 明 ， 确 实 有 一 种 能 够 自我 繁殖 的 细胞 自动 机 存在 ， 虽然 它 复杂 到 了 当时 的 计算 
机 都 不 能 模拟 的 程度 。 冯 ，… 诺 伊 曼 的 这 项 工作 表明 : 一 旦 我 们 把 自我 繁衍 看 做 是 生命 独特 的 
特征 ， 机 器 也 能 做 到 这 一 点 。 


1.1.7. 双 足 步行 机 器 人 


步行 是 人 与 大 多 数 动物 所 具有 的 移动 方式 ， 也 是 生物 界 步 行 方式 中 自动 化 程度 最 高 、 最 
为 复杂 的 动作 ， 它 的 完美 实现 必然 要 求 机 器 人 在 结构 设计 方面 产生 巨大 的 变革 和 创新 ， 从 而 
有 力 地 推动 相关 学 科 的 发 展 。 人 类 一 直 梦 想 着 创造 出 和 人 类 构造 相似 、 能 与 人 类 合作 的 拟人 
机 器 人 。 而 双 足 步行 机 器 人 是 工程 上 少 有 的 高 阶 、 非 线性 、 非 完整 约束 、 强 耦合 性 的 多 自由 
度 系 统 ， 这 为 机 器 人 运动 学 、 动 力学 以 及 控制 理论 的 研究 提供 了 一 个 理想 的 实验 平台 ”| 。 

拟人 机 器 人 是 一 种 具有 人 的 外 形 ， 并 能 够 效仿 人 体 的 某 些 物理 功能 、 感 知 功能 及 社交 能 
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力 并 能 承袭 人 类 的 部 分 经 验 的 机 融 人 。 当 然 ， 拟 人 机 咒 人 的 研究 目的 不 是 企图 制造 以 假 乱 真 
或 替代 人 类 的 机 械 ， 而 是 要 创造 一 种 新 型 工具 ， 它 能 在 典型 的 日 常 环境 中 和 人 类 交流 ， 在 更 
广泛 的 环境 任务 中 扩展 人 类 的 能 

双 足 步行 机 器 人 的 发 展 也 为 人 类 假肢 的 发 展 提供 了 有 力 的 理论 、 技 术 支 持 ， 同 时 也 为 服 
务 、 娱 乐 机 器 人 的 发 展开 辟 了 新 的 领域 。 随 着 机 器 人 的 工作 环境 和 工作 任务 的 复杂 化 ， 双 足 
步行 机 器 人 因 其 体积 相对 较 小 、 对 非 结构 性 环境 具有 较 好 的 适应 性 、 避 障 能 力 强 、 能 耗 小 、 
移动 育 区 很 小 等 优良 的 移动 品质 ， 格 外 引 人 注 目 。 拟 人 机 顺 人 不 仅 具 有 双 腿 、 双 臂 、 头 、 
IR 、 须 、 腰 等 物理 特征 ， 还 能 模仿 人 类 的 视觉 、 触 觉 、 语 言 ， 甚 至 情感 等 功能 。 这 和 能 在 特 
种 环境 下 工作 的 服务 机 器 人 是 有 区 别 的 。 

另外 ， 双 足 步 行 机 咒 人 的 研究 具有 十 分 重大 的 科研 、 实 用 价值 和 意义 ， 可 以 推动 仿生 
学 、 人 工 智 能 、 计 算 机 图 形 学 、 通 信 等 相关 学 科 的 发 展 。 拟 人 机 器 人 的 研究 是 多 学 科 的 交 
又 、 综 合 与 提高 。 机 械 工程 师 、 电 子 学 家 、 计 算 机 专家 、 机 器 人 学 家 、 人 工 智能 专家 、 心 理 
学 家 、 物 理学 家 、 生 物 学 家 、 认 知 学 家 、 神 经 生物 学 家 ， 其 至 哲学 家 、 语 言 学 家 和 艺术 家 等 
都 有 参与 其 研究 。 


1.2 各 国 研 究 状 况 


据 韩 国 一 个 经 常 更 新 的 拟人 机 器 人 网 站 统计 ,目前 世界 各 国有 85 个 大 型 拟人 机 器 人 项 
目 正在 进行 中 ， 这 些 还 不 包括 各 国 单 就 模拟 身体 单个 部 分 的 项 目 。 科 技 部 863 自动 化 办 公 室 
的 工作 人 员 表 示 ， 目 前 所 有 的 大 型 拟人 机 器 人 项 目 中 ， 日 本 占有 37 项 ， 美 国 占 有 10 项 ， 德 
国 占 7 项 ， 韩 国 占 7 项 ， 英 国 占 4 项 , 中 国 占 5 项 ， 瑞 典 占 2 项 ， 澳 大 利 亚 、 泰 国 、 新 加 
坡 、 保 加 利 亚 、 伊 朗 、 意 大 利 、 奥 地 利 、 俄 罗斯 等 国 各 占有 1 项 。 从 统计 数字 可 看 出 日 本 的 
领先 地 位 及 其 他 各 国 的 竞争 实力 。 


1.2.1 日 本 和 韩国 


在 日 本 所 有 的 研究 机 构 中 ， 早 稻田 大 学 、 东 京 工业 大 学 、 本 田 公 司 、 索 尼 公 司 等 研究 机 
构成 为 双 足 步行 机 器 人 研究 的 主力 。 早 稻田 大 学 的 双 足 机 器 人 研究 始 于 1968 年 ， 该 大 学 的 
加 芯 一 即 教 授 所 领导 的 课题 组 相继 研制 了 WL 系列 、WABIAN 系列 双 足 步行 机 器 人 。 最 新 的 
研究 成 果 为 WL-16 和 WABIAN-2 双 足 步行 机 器 人 ， 可 以 在 不 平 的 地 面 上 稳定 行走 六 。 

在 日 本 ， 除 了 各 大 学 都 热衷 于 研究 拟人 机 器 人 外 ， 公 司 的 研发 开始 成 为 主力 。 许 多 过 去 
与 机 器 人 技术 毫 不 相关 的 公司 都 涉足 拟人 机 器 人 的 开发 。 原 因 主 要 有 二 : 一 是 大 公司 利用 公 
众 对 拟人 机 器 人 的 高 度 兴 趣 ， 通 过 成 功 开发 拟人 机 器 人 ， 宣 传 本 公司 的 品牌 ; 二 是 拟人 机 器 人 
有 一 个 很 大 的 市 场 。 研 究 单位 或 成 群 的 发 烧 友 人 迫切 需要 低 价 的 仿 人 机 器 人 整 机 平台 或 套装 件 。 
1.2.1.1 日 本 本 田 公 司 

日 本 本 田 公 司 的 仿 人 机 器 人 工程 开始 于 1986 年 。1986 年 本 田 的 ASIMO 机 器 人 实现 了 可 
以 两 条 腿 行 走 ， 成 功 地 实现 了 双 腿 的 交替 移动 。 但 是 ， 每 一 步 几 乎 要 用 $s 的 时 间 ， 它 只 能 
沿 着 直线 以 很 慢 的 速度 行走 。 第 一 个 完全 独立 ， 依 靠 两 条 腿 行 走 的 拟人 机 器 人 诞 生 于 1997 
年 9 月 ， 身 高 : 1600mm 体重 : 130kg。 通 过 改换 部 件 材料 ， 以 及 将 控制 系统 分 散布 置 ， 降 
低 了 身高 ， 减 轻 了 体重 。 较 小 的 尺寸 更 适宜 在 人 们 的 生活 环境 中 使 用 。 
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经 过 10 年 的 秘密 研究 ，P2 机 器 人 中 在 1996 4E— Zn] pb, f EAE EI, P2 机 器 人 
是 世界 上 第 一 个 无 缆 拟 人 机 器 人 ， 它 能 走 ， 能 上 下 台阶 ， 能 
推 小 车 。P3 是 P2 的 改进 , 减 小 了 尺寸 (重量 由 原来 的 
210kg 降 为 130kg， 高 度 由 1800mm 降 为 1600mm， 提 高 了 步 
行 能 力 。2002 年 12 月 本 田 公 司 又 推出 了 新 型 双 足 步行 机 器 
人 阿 西 葛 ASIMO， 如 图 1.6 所 示 。 和 “P3” 相 比 , 它 的 体形 E 
更 小 、 重 量 更 轻 ， 并 采用 了 新 开发 的 智能 实时 灵活 步行 “I- 
Walkinga (Intelligent Realtime Flexible Walking) 技术 ”实现 
更 加 自由 的 步行 。 本 田 公司 这 个 最 新 款 的 ASIMO 智能 拟人 机 
器 人 主要 有 以 下 几 个 特点 : 基于 认 知 技术 的 先进 的 交流 能 
力 。 它 能 实现 移动 物体 认 知 、 位 置 /姿态 认 知 、 环 境 认 知 、 声 
音 认 知 和 面部 认 知 。@) 网 络 集成 能 力 , 它 能 与 用 户 网 络 系统 
相连 完成 用 户 指令 ， 还 能 通过 互联 网 为 主人 的 问题 寻找 答 LE 
案 。 图 1-6 ASIMO 拟人 机 器 人 

2004 年 12 H 15 日 本 田 公 开 了 新 一 代 ASIMO 双 足 行走 机 器 人 ， 提 高 了 移动 性 能 ， 其 目 
标 是 可 在 实际 环境 中 快速 判断 情况 、 敏 捷 行动 。 通 过 利用 上 半身 弯曲 及 扭曲 的 新 姿态 控制 理 
论 ， 以 及 新 开发 的 高 速 响应 硬件 ， 加 上 可 与 慢跑 媲美 的 动作 ， 实 现 了 时 速 3km 行走 ， 正 常 
行走 时 速 为 2. 5km/h， 能 实现 跑 动 时 速 为 6km/h。 其 高 度 为 1.3m， 总 重 为 54kg， 具有 34 个 
自由 度 ， 其 中 下 肢 12 个 自由 度 ， 如 图 1-7 所 示 。 它 采用 与 人 一 样 自 然 行走 的 新 姿态 控制 技 
术 、 自 律 连续 移动 技术 ， 以 及 可 顺畅 地 与 人 同步 动作 的 技术 等 。 


XINHUANET/RE 


图 17 新 一 代 “ASIMO” 双 足 行 走 机 器 人 


在 连续 移动 方面 ， 它 通过 由 地 面 传感器 获得 的 周 于 信息 ， 以 及 在 步行 的 同时 对 照 事 先 存 
入 的 地 图 信息 ， 可 对 路 线 错 误 进行 修正 ， 当 检测 到 有 障碍 物 时 ， 可 凭借 自己 的 判断 而 绕 开 ; 
同时 ， 通 过 头 部 的 视觉 传感器 及 新 追加 的 手腕 力 觉 传感器 等 ， 可 检测 人 的 动作 、 接 拿 物 品 ， 
以 及 按照 对 方 的 动作 节奏 握手 ; 可 以 做 出 将 脚 迈 向 手 部 被 推拉 的 方向 等 与 人 动作 同步 的 动 
作 。 

2007 年 9 月 27 日 ,本 田 公司 主导 开发 的 新 版 ASIMO 机 器 人 在 西班牙 巴塞 罗 那 亮相 。 经 
过 7 年 研发 的 新 版 ASIMO 机 器 人 身高 为 1.2m， 体 重 为 43kg， 由 移动 电话 控制 ， 能 有 以 酷似 
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人 类 的 姿势 活动 ， 与 以 前 版 本 的 机 器 人 相 比 ， 加 强 了 与 人 类 交流 的 能 力 。 
1.2.1.2. 日 本 索尼 公司 

提 到 拟人 机 器 人 ， 我 们 就 不 得 不 提 到 日 本 的 索尼 公司 ， 该 公司 在 拟人 机 器 人 方面 做 出 的 
贡献 是 有 目 共 睹 的 ， 从 最 初 的 AIBO 到 SDR-4X、SDR-4X II 再 到 QRIO ， 无 不 表现 出 非凡 的 
创意 。 

索尼 公司 的 工业 机 器 人 产业 始 于 1980 4E, 1997 年 启动 拟人 步行 机 器 人 研究 计划 ， 样 机 
取 名 SDR (Sony Dream Robot， 索 尼 梦 幻 机 器 人 ) ， 以 梦幻 般 的 演技 为 目标 。 起 步 虽 晚 但 
索尼 公司 能 利用 后 发 优势 ， 注 意 吸 取 前 人 的 经 验 ， 特 别 是 早稻 田 大 学 的 成 果 。 索 尼 ABO 4% 
能 玩具 狗 享 誉 世界 ， 是 四 足 智 能 机 器 人 的 杰作 。 索 尼 拟 人 双 足 步行 机 器 人 的 构思 与 AIBO 一 
脉 相 承 ， 即 供 娱乐 表演 的 商品 ， 也 显示 出 后 来 居 上 的 势头 。 

2002 年 推出 的 SDR-4X 新 型 机 器 人 强化 了 人 机 对 话 功 


能 ， 提 高 通信 能 力 ， 并 且 在 运动 性 能 方面 做 了 改进 ， 以 组 & = 

FRAT vp: 7], WA 1-8 所 示 。 " m 
SDRAX 具有 以 下 特点 : 4 e; 
(1) 尺度 小 巧 、 体 态 轻便 ”出 于 玩具 化 、 商 品 化 的 €» | 


IE, SDR-AX ( 见 图 1-8) 的 外 形 尺 寸 (高 x 宽 x 厚 ) 
仅 为 S0cm x22cm x 14cm， 这 带 来 诸多 优点 ， 如 安全 、 节 
省 能 源 、 便 于 携带 等 ， 然 而 也 伴 有 若干 问题 ， 如 倾倒 过 程 
加 快 ， 控 制 响应 时 间 更 短 等 。 索 尼 公 司 创新 研究 所 长 土 井 
利 忠 认 为 ， 下 一 代 产 品 的 目标 是 身高 为 30 ~ 40cm， 自 重 
为 2 ~3kg。 

(2) 全 号 协 调运 动 控制 ^ ASIMO 相反 ，SDR-4X 主 pig spnax 双 足 娱乐 机 器 人 
要 靠 上 身 表 演 动 作 ， 下 身 仅 仅 适 从 跟随 。 由 于 在 腰 关 节 特 
设 了 两 个 自由 度 ， 因 此 她 能 表演 展 臂 、 臂 又 、 跑 球 、 倾 倒 后 自 站 立 、 优 美 舞 姿 等 。 

(3) 伺服 电动 机 的 机 械 -电气 -驱动 -控制 的 一 体 化 ”SDR-4X 安装 ISA 系列 的 3 种 体积 
小 、 重 量 轻 、 精 度 高 、 内 藏 减速 器 和 专用 集成 电路 (ASIC) 驱动 控制 电路 板 的 专用 AcC 伺服 
电动 机 , 真正 实现 了 电动 机 集成 技术 。 该 系列 自制 电动 机 的 重量 仅 是 同类 传统 电动 机 的 
1/4 ~1/5, 

(4) 智能 化 ”SDR-4X 与 AIBO 机 器 狗 采 用 相同 的 
OPEN-R 系统 软件 。 不 同 的 是 需要 进一步 开发 借助 身段 、 
手势 、 声 音 等 在 一 定 程 度 上 与 人 交流 的 功能 ， 以 接近 人 类 
的 丰富 表达 力 。 其 中 视觉 和 听觉 不 可 或 缺 ， 而 语音 能 力 万 
为 期 待 和 困难 。 

2003 4E 3 H 24 日 索尼 公司 发 布 了 新 一 代 机 器 人 模 
型 一 一 SDR-4X I, "nA 1-9 所 示 ， 它 是 SDR-4X 的 升级 产 
品 ， 可 以 在 失去 平衡 时 自动 校正 ， 或 者 对 旋转 方向 或 者 对 
前 后 左右 作 调整 。 跌 倒 时 ， 它 还 可 以 自己 站 起 来 ， 重 新 恢 
复 正常 状态 。 另 外 ，SDR-4X [I 还 可 以 识别 位 置 ， 通 过 内 
存 的 地 图 自行 到 达 目 的 地 。 对 于 颜色 它 也 能 很 好 地 识别 ， 图 1-9 双 足 行走 机 器 人 SDRAX TI 
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能 够 根据 颜色 判断 地 点 。 在 语言 方面 ，SDR-4X mT TE TEES, AH CPU， 可 以 实现 
更 精准 的 语言 连续 识别 。 在 记忆 上 ， 它 能 记 住 更 多 的 对 
话 。 

2003 年 12 月 11 日 在 日 本 东京 “索尼 科学 探索 ”的 
媒体 预展 会 上 上， 索尼 公司 又 推出 了 索尼 QRIO 一 一 世界 首 
台 会 跑 的 双 足 步行 机 器 人 ， 如 图 1-10 所 示 。 索 尼 定 义 的 
“ 跑 ” 的 概念 是 指 机 器 人 行走 时 双 足 处 于 离开 地 面 的 非 
接触 状态 (Loss of Contact) ， 并 不 是 那 种 一 定 要 革 只 脚 
接触 地 面 像 竞 走 那样 的 “ 快 步 走 ”。 据 索尼 公司 介绍 ， 
此 前 世界 上 没有 可 以 在 不 接触 地 面 的 状态 下 行走 的 机 器 
人 。 此 次 开发 的 双 足 行走 机 器 人 在 行走 时 可 以 约 有 20ms 
的 不 接触 地 面 的 时 间 。 该 机 器 人 不 仅 可 以 行走 ， 而 且 可 
以 跳跃 ， 在 跳跃 状态 下 不 接触 地 面 的 时 间 可 达 40ms。 行 i d 
走 速度 为 14m/min。 如 果 假 设 其 大 小 与 人 相同 ， 换 算 过 
来 相当 于 时 速 0. 84km/h， 给 人 以 缓 缓慢 跑 的 印象 。 

索尼 公司 的 QRIO 是 世界 上 首 个 会 跑 的 人 形 机 器 人 。 为 防止 机 体 的 关节 部 分 挂 住 用 户 的 
衣服 、 手 指 等 ， 还 特意 在 关节 部 位 采用 了 圆 弧 设计 。QRIO 有 着 良好 四 肢 协调 性 能 。 之 后 ， 
索尼 公司 在 这 个 基础 上 强化 了 人 机 对 话 功 能 、 提 高 通信 能力， 进一步 在 运动 性 能 方面 做 了 改 
进 ， 以 缓和 摔 倒 时 的 冲击 力 ， 于 是 “QRIO” 诞 生 了 。 这 个 机 器 人 可 以 漫步 、 跳 舞 ， 并 可 做 
很 多 高 难度 动作 ， 它 甚至 可 以 指挥 一 个 小 型 乐队 。 

“QRIO” 的 运动 性 能 与 通信 能 力 方面 都 增加 了 新 功能 。 如 强化 了 双 足 行走 功能 、 跌 倒 后 
自己 站 起 来 的 功能 、 识 别 用 户 的 功能 等 。 追 加 的 这 些 功 能 均 是 针对 普通 用 户 设计 的 。 为 实现 
上 述 功能 ，QRIO 上 内 置 的 两 个 微 处 理 絮 分 别 作 为 运动 中 枢 和 思维 中 枢 ， 分管 运动 功能 与 思 
维 功能 。 这 些 性 能 的 设计 ， 很 大 程度 上 以 在 普通 家 庭 中 的 共同 生活 为 目标 ， 即 便 行 走路 面 叫 
凸 不 平 ， 或 者 有 台阶 或 斜坡 ， 也 能 照常 行走 。 

此 外 ， 索 尼 公 司 都 将 机 器 人 与 音频 相 结合 的 表演 作为 机 器 人 展示 中 的 重要 部 分 ， 如 
QRIO 的 太极 拳 表演 ， 用 节奏 不 强 的 音乐 和 动作 配合 太极 拳 、 千 手 观 音 等 节奏 性 不 强 的 动 
作 ， 以 此 来 弱化 节奏 在 音乐 表演 中 的 作用 ， 这 种 表演 方式 尤其 适合 中 国 传统 民乐 和 古 曲 的 音 
乐 的 动作 表演 ， 如 图 1-11 和 图 1-12 所 示 。 


图 1-10 跑步 中 的 索尼 新 型 QRIO 


1-11. QRIO 随 音乐 进行 的 太极 拳 表演 
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El 1-12 QRIO KEE /EGT RU REP Ae TR 


1.2.1.3 其 他 

Wk (Kondo) 公司 研发 了 专门 用 于 拟人 机 器 人 的 伺服 电动 机 ， 并 将 其 用 于 开发 低 价 拟 
人 机 器 人 。 他 们 将 机 器 人 结构 彻底 简化 ， 并 将 自由 度 总 数 降 至 最 少 (17 个 ) ， 开 发 了 当时 最 
轻 、 最 小 的 KTR21 仿 人 机 器 人 ， 该 机 器 人 市 场 价 开创 了 最 低 价 的 记录 。KTR21 BHA 17 个 
自由 度 ， 但 可 以 完成 走路 、 体 操 〈 俯 卧 撑 、 前 滚 翻 、 后 滚 翻 、 侧 手 翻 、 头 手 倒 立 ) 等 动作 ， 
它 可 用 角度 输入 法 或 示 教 方法 编程 ， 可 用 于 教学 和 科研 ， 如 图 1-13 所 示 。 在 2004 年 12 月 
ERARI, AFET 21 个 自由 度 的 YDH2EZA 拟人 机 器 人 ， 标价 仅 为 92400 日 
元 ， 性价比 更 好 。 

目前 ， 商 品 化 的 仿 人 机 器 人 还 只 有 日 本 在 生产 。 在 日 本 已 经 形成 多 家 公司 竞相 人 研制 拟人 
机 器 的 气候 ， 所 研发 的 仿 人 机 器 人 也 呈现 多 种 型 号 、 各 种 级 别 并 存 的 局 面 。 

日 本 Speecys 公司 推出 了 能 够 利用 装置 分 析 软 件 进 行动 作 模拟 的 “Real Motion System" 
双 足 行走 机 器 人 开发 环境 。 可 使 用 三 维 CAD 软件 “SolidWorks” (美国 SolidWorks 公司 出 
品 ) 及 作为 其 插件 的 COSMOSMotion 运动 分 析 软 件 ， 对 该 公司 “Speecys (SPC-003) ”新 型 
双 足 行走 机 器 人 的 动作 进行 模拟 。 主 要 面向 大 学 等 研究 领域 销售 。 

Real Motion System 包括 SPC-003 的 三 维 模型 ， 为 该 模型 设置 动作 后 进行 分 析 。 由 于 能 够 
考虑 重心 、 扭 矩 和 惯性 等 因素 ， 因 此 能 检测 在 所 定义 的 动作 过 程 中 是 否 会 摔 倒 ， 零 部 件 之 间 
是 否 有 干扰 。 

过 去 ， 都 是 直接 将 动作 编辑 器 定义 的 条 件 直 接 输 给 机 器 人 ， 使 之 运动 。 但 是 ,动作 编辑 
器 只 是 设 定 各 关节 的 转动 角度 及 其 次 序 ， 并 不 能 考虑 平衡 等 因素 。 所 以 很 难 定义 出 可 使 机 器 
人 保持 平衡 、 不 会 摔 倒 的 动作 ， 在 定义 动作 时 都 需要 反复 摸索 。 据 称 ， 在 定义 动作 的 过 程 中 
有 时 还 会 损坏 机 如 人。 如 果 使 用 Real Motion System ， 由 于 能 够 全 部 在 桌面 上 进行 研究 ， 因 此 
就 能 防止 上 述 问题 。 另 外 ， 修 改 部 件 形状 ， 或 追加 新 的 部 件 时 ， 也 能 预先 利用 SolidWorks 和 
COSMOSMotion 验证 平衡 性 ， 因 此 能 够 提高 开发 速度 。 
1.2.1.4 日 本 机 器 人 研究 主要 代表 人 物 

十 田 贵 之 ， 日 本 科技 振兴 事业 团 (ERATO) 北野 共生 系统 工程 研究 员 、 青 山 学 院 特聘 
研究 员 。1968 年 出 生 ,1996 年 任 青山 学 院 E-sys 研究 室 主要 成 员 ， 独 自 一 人 开发 了 Mk 系列 
步行 机 器 人 研究 平台 ， 被 誉 为 机 器 人 开发 的 年 青 奇才 。 
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D 传感器 

人 形 机 器 人 必 不 可 少 的 是 掌 
握 驱 动 状态 的 传感器 。 检 测 
整个 身体 状态 的 陀螺 仪 在 性 
能 和 小 型 化 设计 方面 也 越 来 
越 进 步 。 了 解 外 部 情况 时 必 
不 可 少 的 视觉 和 听觉 研究 将 
M ME DU 
是 高 


» 处 理 器 

起 着 处 理 传感器 信息 的 大 脑 

作用 。 给 整个 身体 配备 一 个 

小 型 大 脑 的 分 散 控 和 方式 已 
经 逐步 成 为 主流 ， 因 此 CPU 


其 他 领域 


可 利用 于 
的 机 器 人 


技术 


> 控制 


。 分 散 控制 方式 


) 系 统 进 


于 减轻 体重 和 


BUS 
MEREEN , 大 型 机 器 
使 用 的 是 车 用 铝 酸 蓄电池 。 
E) | 的 是 镍 氢 电池 和 数 


jJ 
已 


NP 


HNE >a v 


池 的 机 器 


E 


小 型 机 器 人 中 有 的 是 直接 把 
驱动 


a! 


风机 身 的 机 器 人 已 


， 具 有 和 人 一 样 
， 外 表 包 囊 轻 量 
前 的 发 展 趋势 ， 而 


装置 用 作 机 身 的 一 部 分 


[mA 


THRA, SUE ASIMO 开发 室 经 理 、 主 任 工 程 师 。 
1986 年 加 入 本 田 技 术 研 究 所 ， 是 


ASIMO 机 器 人 的 研发 者 。 


石田 健 藏 ， 索 尼 创 新 研究 所 第 2 部 长 。 
大 学 客座 研究 员 , 此 后 至 1996 年 从 事 工 业 机 器 人 和 高 速 插件 机 的 研发 应 用 ， 


1-13 *Speecys (SPC-003)” 新 型 双 足 行走 机 器 人 


的 负载 变 小 了 。 不 过 ， 在 
音 与 图 像 的 识别 处 理 领域 ， 
必须 进一步 提高 性 能 


» 材料 

现 阶段 主要 沿 
家 电 的 外 装 使 用 
实 ” 的 新 材料 。 
人 的 情况 下 也 能 确保 人 身 安 
全 ， 对 化 学 材料 也 寄予 了 越 


驱动 装置 

机 器 人 依靠 装 在 关节 部 位 的 
磁 电动 机 来 运动 。 如 果 直 接 
沿用 轻 量 和 小 型 化 需求 不 高 
的 产业 机 器 人 电动 机 ,手臂 和 
腿 都 会 变 大 ， 整 个 机 器 人 的 
身体 也 会 变 大 ， 为 了 设计 出 
能 够 跟 人 一 起 生活 的 机 器 人 ， 
必须 要 有 大 扭矩 的 小 型 电动 
机 ， 最 近 ， 可 像 人 的 肌肉 一 
样 运动 的 人 造 肌 肉 的 研究 也 
在 进行 ， 作 为 驱动 机 器 人 的 
驱动 装置 受到 了 业界 的 广泛 
关注 


: 参考 日 本 千 叶 工业 大 学 “mormph3” 而 设计 的 机 器 人 示意 图 


1974 年 早稻 田 硕士 毕业 ， 


责 SDRAX 机 器 人 的 研制 。 


北野 宏明 ， 现 任 ERATO 的 北野 共生 系统 


工程 


1956 年 出 生 
E (E0 ~E6) 系列 机 器 人 、P (P1 ~ P3) 系列 机 器 人 及 


，1980 年 硕士 毕业 ， 


1976 ~ 1977 年 斯 坦 福 
1997 年 开始 负 


负责 人 ，1961 年 出 生 ， 工 学 博士 。 该 工程 
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包括 “拟人 机 器 人 与 人 工 智能 ”和 “分 子 生 物 学 的 生命 系统 ”两 大 项 目 ， 互 有 关联 。1993 年 
获得 被 誉 为 人 工 智 能 诺 贝尔 奖 的 “The Computers and Thought Award (计算 机 与 思维 奖 )” 奖 ， 
1999 年 当选 新 闻 周 刊 《News week) 21 世纪 100 位 杰出 人 才 。 他 是 机 器 人 足球 世界 杯 主席 。 
高 西 淳 夫 ，1980 年 毕业 于 早稻田 大 学 ，1985 年 获 硕士 学 位 ，1988 年 获 博士 学 位 ， 学 生 
时 代 即 参与 WL-9DR 的 研究 ， 提 出 “ 准 动态 步 行 步 态 ” 的 概念 。 一 直 从 事 类 人 双 足 步行 机 
器 人 的 研究 。 
1.2.1.5 韩国 的 机 器 人 发 展 
与 此 同时 ， 韩 国正 在 急 起 直 追 。2004 年 12 月 27 日 ， 韩 国 先进 科技 研究 所 (KAIST) 发 
XY HUBO 机 器 人 。 这 个 机 器 人 高 为 123em， 重 为 5kg， 具 有 41 个 自由 度 ，10 个 手指 都 
能 独立 活动 ， 双 眼 可 以 转动 。 研 究 经 费 耗资 2000 万 韩元 ， 就 在 两 天 后 ， 韩 国 另 一 家 研究 机 
构 韩 国 科技 研 究 所 (KIST) 也 发 表 了 NBH21 机 器 人 ， 这 个 机 器 人 高 为 150cm， 重 为 67kg， 
据 称 机 器 人 的 软件 可 通过 网 络 从 服务 器 得 到 更 新 ， 如 图 1-14 所 示 。 


图 1-14 韩国 的 HUBO 拟人 机 器 人 


1.2.2 美国 和 欧洲 


(1) 麻 省 理工 学 院 机 器 人 1999 年 美国 麻 省 理工 学 院 研 制 出 了 COG WAUA, H 
头 、 躯 干 、 胎 膊 及 双手 组 成 。 它 是 人 和 人 工 智 能 等 领域 的 一 个 平台 。2005 年 麻 省 理工 学 院 
研制 出 具有 29 个 自由 度 的 Domo 机 天 人 。 同 年 该 学 院 还 研发 出 双 足 学 习 机 器 人 ， 采 用 “被 
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动 动力 学 (Passive Dynamic)” 理 论 设计 ， 部 分 关节 没有 电动 机 和 控制 器 ， 却 能 实现 非常 类 
人 的 运动 。 
麻 省 理工 大 学 研制 的 Kismet 机 器 人 ， 如 图 1-15 所 示 。 


Kismet 总 共有 21 个 自由 度 ， 如 图 1-16 所 示 。3 个 自由 度 控 制 眼球 注视 的 方向 ，3 个 控 
制 头 部 的 方向 ， 其 余 15 个 控制 面部 表情 (HEB. JH. WEM), Kismet 的 眼 部 有 4 个 
CCD 照相 机 、2 MEFE ARo 


照相 机 
pe pg 
CD RT E 
» 9 8 
- Rm 左 眼 面板 
= à © nuns D 
E Q us zt 
围 的 摄像 头 P 
O 旋 续 轴 十 人 


语音 合成 器 头 部 定位 


图 1-16 Kismet 机 器 人 组 成 


其 功能 有 : 视觉 跟踪 ， 采 用 图 像 处 理 技术 ， 跟 踪 物 体 ; 面部 可 以 呈现 一 些 表 情 ， 主 要 的 
面部 表情 运动 有 眉毛 和 嘴 ; 可 以 讲话 ， 通 过 语音 识别 和 人 工 智能 技术 ， 实 现 与 人 进行 简单 的 
语音 交互 功能 ;表达 情感 ， 这 个 功能 是 Kime 一 个 非常 突出 的 功能 ， 根 据 人 的 表情 、 环 境 
等 表达 自己 的 情绪 ， 例 如 高 兴 、 人 惊讶 、 诅 丧 等 。 图 1-17 所 示 是 Kismet 机 器 人 情感 表达 空间 ， 
表示 了 Kismet 机 器 人 的 情绪 分 布 情况 。 根 据 机 器 人 的 情感 可 以 表达 出 来 机 器 人 情绪 状态 ， 
意味 着 机 器 人 将 不 再 是 一 个 冰冷 的 金属 装置 ， 它 们 也 慢 慢 地 具有 了 类 似 人 的 情绪 ， 表 达 类 似 
人 的 情感 。 这 是 机 器 人 研究 的 一 个 重大 进步 。 
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开放 式 站 姿 


消极 的 


封闭 式 站 姿 
1-17 Kismet 机 器 人 的 情感 表达 空间 


PR] 


Kismet 不 光 具 有 上 述 一 些 功能 ， 还 具有 学 习 能 力 ， 通 过 人 的 不 断 训 练 ， 它 可 以 通过 学 习 
不 断 地 完善 自己 的 表达 ， 可 以 看 出 来 ，Kismet 机 器 人 是 一 个 聪明 的 家 伙 ， 虽然 他 没有 强健 的 
身体 ,但 是 它 的 大 脑 开始 不 断 地 强大 起 来 。 

(2) Rabbit 机 器 人 ”法国 格 勒 诺 布尔 自动 化 实验 室 的 Rabbit 是 世界 上 第 四 个 可 以 跑 动 
的 双 足 步行 机 器 人 ，Rabbit 拥有 较 简 单 的 机 械 结构 ， 它 没有 脚 ， 只 有 一 对 “ 脚 距 "， 即 一 对 
枢 轴 ， 这 样 的 设计 使 得 Rabbit 在 向 前 迈步 时 ， 整 条 腿 能 够 绕 着 枢 轴 转动 ， 如 图 1-18 所 示 。 
其 原型 高 1. 425m， 重 36kg。Rabbit 是 按照 机 械 结构 最 简单 来 运动 的 。 


图 1-18 ”法国 格 勒 诺 布 尔 自动 化 实验 室 的 Rabbit 机 器 人 
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此 外 , 2004 年 NASA 科学 家 Dr. Mark W. Tilden 依照 (生物 学 、 电 子 学 、 美 学 、 机 械 
^£) (Biology, Electronics, Aesthetics and Mechanics, BEAM) 四 大 原理 与 技术 设计 开发 出 


Robo Sapi En 双 足 娱乐 型 机 器 人 。 


德国 菜 尼 黑 技 术 大 学 的 Johnnie， 开 发 了 具有 17 个 自由 度 ， 身 高 为 1.8m， 重 量 为 40kg 
(不 带电 源 ) ， 其 中 上 肢 有 2 个 自由 度 ， 在 行走 时 摆动 来 补偿 重力 矩 变 化 。 其 关节 由 直流 电 


动机 加 齿轮 传动 机 构 来 驱动 ， 关 节 转 角 和 速度 由 增 量 码 盘 测 
量 。 采 用 了 数字 传感器 以 最 小 化 数字 扰动 ， 足 部 装 有 六 维 力 传 
感 器 。 主 机 采用 PA 2. 8GHz 处 理 器 ， 利 用 PCI 总 线 实现 与 传 感 
器 和 驱动 器 间 的 数据 传输 。 整 个 控制 算法 运行 于 RT-Linux 实 
时 操作 系统 。 其 行走 时 速 为 2.2km/h， 它 是 2003 年 当时 世界 
上 行走 速度 最 快 的 双 足 步行 机 器 人 ， 也 是 世界 上 最 高 的 双 足 步 
行 机 器 人 ， 能 实现 平稳 行走 ， 进 行 图 像 识 别 和 自主 避 障 功能 。 

2005 年 2 月 21 日 召开 的 第 171 届 美 国 科学 促进 会 的 年 会 
上 ， 由 美国 康 奈 尔 大 学 、 麻 省 理工 学 院 和 和 蓓 兰 代 尔 夫 特 理工 大 
学 的 科学 家 分 别 组 成 的 研究 小 组 ， 展 示 了 他 们 研制 出 的 能 以 人 
类 步 态 直立 行走 的 被 动 动力 行走 机 器 人 ， 被 认为 代表 了 当前 被 
动 动力 机 器 人 人 研究 的 最 新 成 果 ， 如 图 1-19 所 示 。 


lim 


1.3 国内 研究 状况 


图 1-19 WABLAN-4 机 器 人 


与 国外 相 比 ， 我 国 从 20 世纪 80 年 代 中 期 才 开 始 研究 拟人 机 器 人 。 在 “七 五 ”期 间 ， 
国防 科技 大 学 和 哈尔滨 工业 大 学 等 单位 分 别 进行 了 人 研究。 在 “863” 项 目 支 持 下 ， 国 内 的 机 


器 人 研究 有 了 长 足 的 发 展 。 

(1) 北京 科技 大 学 机 器 人 北京 科 
技 大 学 在 研究 机 器 人 方面 取得 了 巨大 的 
成 绩 ，2005 年 北京 科技 大 学 研制 了 双 足 
步行 机 器 人 ， 如 图 1-20 所 示 。 它 是 具有 
17 个 自由 度 的 ， 并 可 在 平面 上 做 各 种 拟 
人 动作 的 双 足 步行 机 器 人 ， 采 用 了 智能 
技术 ， 通 过 无 线 传 输 ， 可 使 多 个 机 器 人 
同时 进行 表演 ， 可 以 模拟 人 类 的 前 进 、 
后 退 、 转 弯 、 下 蹲 、 侧 翻 、 打 太极 拳 、 
体操 表演 、 直 立 前 行 行走 、 前 滚 翻 、 后 
滚 翻 、 做 俯卧 撑 、 伏 地 起 身 、 上 下 楼 梯 。 

2006 年 ， 北 京 科技 大 学 独立 研制 了 
具有 人 类 外 观 特征 的 大 型 机 器 人 乐 乐 
(JILE 1-21), 他 具有 人 脸 识 别 、 语 音 识 


1-20 


能 。 随 后 北京 科技 大 学 又 研制 出 了 大 型 机 器 人 娜 娜 ( 见 


图 小 型 双 足 机 器 人 
别 、 动 作 表演 、 生 活 和 常识 、 背 诗 、 聊 天 、 旅 游 常 识 、 唱 歌 、 生 活 常识 、 脑 筋 急 转 弯 等 多 种 功 
图 


122), ， 并 参加 了 天 津 科技 馆 的 展 


20 


出 ， 娜 娜 高 度 和 人 的 身高 相仿 ， 能 模仿 人 的 各 种 基本 动作 ， 同 时 具备 语音 识别 与 语音 合成 功 
能 ， 可 实现 预定 内 容 的 人 机 交互 ; 主机 器 人 可 以 和 客人 进行 日 常用 语 对 话 ， 进 行 场馆 的 内 容 


介绍 ， 可 以 实现 不 同 声调 的 变换 ， 如 男声 、 女 声 、 卡 通 声 音 等 。 

北京 科技 大 学 于 2007 年 初 在 重庆 展 出 了 又 一 拟人 机 器 人 爱 因 斯 坦 ( 见 图 1-223) ， 具 有 
语音 对 话 能 力 ， 男 声 ， 具 备 数据 库 更 新 能 力 ， 可 以 随时 更 新 内 容 ; 能 模仿 人 的 各 种 基本 动 
JE, WHESK. Mk. ERIKA, EIR, WERE, SHR, KERTIER, Jahi, tepi, F 
等 动作 ， 还 可 与 展区 的 其 他 机 器 人 配合 进行 互动 表演 。 

2007 年 12 月 ， 北 京 科技 大 学 在 大 庆 科 技 馆 展 示 了 由 大 型 机 器 人 科大 一 号 ( 见 图 1-24) 
和 双 足 步行 机 器 人 (ILEI 1-20) 组 成 的 机 器 人 团体 表演 ， 科 大 一 号 可 以 通过 传感器 网 络 感 
知 环境 ， 有 方向 感 ， 可 实现 一 定 范围 内 的 机 器 人 全 方位 自主 运动 ， 机 器 人 的 作业 臂 可 以 灵活 
地 运动 。 除 此 之 外 ， 它 还 可 以 进行 跳舞 、 唱 歌 、 背 唐诗 等 表演 ， 脸 部 采用 动画 显示 表情 ， 可 
以 作出 多 种 表情 ; 通过 多 媒体 计算 机 还 可 进行 查询 及 场景 解说 。 双 足 步 行 机 器 人 主要 是 通过 
控制 舵 机 来 模仿 人 的 身体 结构 和 关节 运动 ， 可 以 在 平面 上 做 各 种 拟人 动作 ， 采 用 了 智能 技 
术 ， 通 过 无 线 传输 ， 可 以 多 个 小 型 机 器 人 同时 进行 表演 ， 可 以 实现 人 的 行走 、 做 俯卧 撑 、 鞠 
躬 、 踢 球 等 多 种 动作 的 模仿 。 


图 1-21 乐 乐 图 1-22” 娜 娜 图 1-23” 爱 因 斯 坦 图 1-24 科大 一 号 


(2) 哈尔滨 工业 大 学 机 器 人 “哈尔滨 工业 大 学 是 较 早 研制 双 足 步行 机 器 人 的 高 校 ， 它 
开始 于 1985 年 ， 早 期 的 机 器 人 没有 头 部 和 双 辟 ， 到 1995 年 研制 成 功 了 HITI, HITIA HIT 
亚 59 三 个 型 号 。1995 年 研制 成 功 的 HIT 机 器 人 的 双 腿 具有 12 个 自由 度 ， 中 关节 由 两 个 正 
交 电动 机 构成 ， 同 时 实现 两 个 自由 度 。2004 年 6 月 ， 哈 尔 滨 工业 大 学 研制 成 功能 用 脚 足球 
的 双 足 拟人 足球 机 器 人 。 

(3) 国防 科技 大 学 机 器 人 号 ;2000 年 ， 在 国防 科技 大 学 诞生 了 我 国 独立 研制 的 第 一 台 
具有 人 类 外 观 特征 、 可 以 模拟 人 类 行走 与 基本 操作 功能 的 “先行 者 ”平面 拟人 机 器 人 。“ 先 
行者 ”高 为 114m、 重 为 20kg， 具 有 人 一 样 的 身躯 、 脖 子 、 头 部 、 眼 睛 、 双 臂 与 双 足 ， 并 有 具 
备 了 一 定 的 语言 功能 。 目 前 国防 科技 大 学 研制 的 新 型 拟人 机 器 人 有 36 个 自由 度 , 其 中 每 条 
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腿 各 6 T, EAKR 6, FR5 个， 头 部 2 个 ,下肢 各 个 关节 有 位 置 传感器 ， 足 部 有 多 
维 力 力矩 传感器 ; 整个 控制 系统 、 电 源 集成 在 机 器 人 本 体 上 。 采 用 一 种 以 DSP 为 核心 、 
CAN 总 线 为 通信 标准 的 新 型 控制 结构 进行 控制 。 

(4) 北京 理工 大 学 机 器 人 “我 国 第 一 个 真正 意义 上 的 BHR-1 拟人 机 器 人 在 2002 年 12 
月 通过 了 国家 863 项 目 组 的 验收 。 该 机 器 人 按照 亚洲 人 的 标准 ， 身 高 为 1158mm， 体 重 为 
76kg。 它 全 身 有 32 个 关节 ， 使 其 活动 起 来 比较 自如 ， 步 幅 为 0.133m， 速 度 为 1km/h。 机 器 
人 和 手 、 脚 可 以 完成 360° 的 旋转 ， 比 人 更 灵活 。 除 了 行走 ， 它 还 能 足下、 站 起 、 原 地 踏步 、 
打 太 极 拳 。 这 个 机 器 人 还 会 腾空 行走 ， 并 能 根据 自身 的 平衡 状态 和 地 面 高 度 变 化 ， 实 现 未 知 
路 面 的 稳定 行走 。 在 系统 集成 、 步 态 规 划 和 控制 系统 等 方面 实现 了 重大 的 突破 。 目 前 BRH-1 
已 经 研制 到 第 3 代 “ 汇 童 ”， 高 度 为 116cm， 重 量 为 63kg， 突 破 了 仿 人 机 器 人 的 复杂 动作 设 
计 ， 在 国际 上 首次 实现 了 模仿 太极 拳 、 刀 术 等 人 类 复杂 动作 。2005 年 9 月 18 日 ， 由 北京 理 
工大 学 牵头、 中 科 院 沈阳 自动 化 所 、 兵 器 工业 集团 惠 丰 机 械 有 限 公司 、 航 天 工业 集团 红 林 机 
械 三、 中科院 北京 自动 化 所 等 单位 参加 ， 通 过 3 年 的 奋斗 ， 研 制 的 “ 汇 童 ”拟人 机 器 人 ， 
如 图 1-25 所 示 。 该 拟人 机 器 人 是 科技 部 “十 五 ”863 计划 先进 制造 与 自动 化 领域 机 器 人 技 
术 主 题 的 重点 项 目 ， 同 时 得 到 了 国防 科 工 委 国防 预 研 专项 、 国 防 基础 科研 重点 专项 、 北 京 理 
工大 学 985 工程 科技 创新 专项 等 大 力 扶 持 。“ 汇 童 ”身高 为 1. 60m， 体 重 为 63kg， 全 身 共 有 
32 个 自由 度 ， 配 备 力 传感器 、 视 觉 传感器 、 加 速度 计 、 倾 角 计 、 编 码 器 等 各 类 传感器 共 44 
个 ， 可 模仿 人 类 前 进 、 后 退 、 侧 行 、 转 弯 、 上 下 人 台阶、 太极 拳 、 刀 术 等 各 种 复杂 动作 。“ 汇 
童 ”是 具有 视觉 、 语 音 对 话 、 力 觉 、 平 衡 觉 等 功能 的 自主 知识 产权 的 拟人 机 器 人 ， 功 能 达 


图 1-25 “ 汇 童 ” 双 足 机 器 人 
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到 了 国际 先进 水 平 ， 它 的 成 功 研制 标志 着 我 国 成 为 少数 掌握 集 机 构 、 控 制 、 传 感 器 、 电 源 于 
一 体 的 高 度 集成 技术 的 国家 。 

(5) 清华 大 学 机 器 人 ”清华 大 学 设计 的 THBIP 机 器 人 ， 本 体 结构 类 人 ， 共 设置 32 个 自 
由 度 ， 头 部 2 个 ， 上 肢 12 个 , 下 肢 12 个 ,， 手 部 6 人 个。 躯干 部 装 有 陀螺 姿态 传感器 ， 脚 底 和 
手腕 装 有 六 维 力 传感器 ; 各 关节 装 有 位 置 传感器 。 机 器 人 采用 模糊 非 线 性 控制 ， 成 功 实现 了 
无 缆 连 续 稳 定 的 平地 前 进 、 后 退 、 侧 行 、 连 续 上 下 台阶 行走 ， 以 及 端 水 、 太 极 拳 和 点 头等 动 
作 。 

除 以 上 单位 外 ， 上 海 交 通 大 学 等 单位 也 在 进行 相关 研究 !'9 。 


1.4 其 他 相关 技术 


拟人 机 器 人 研究 在 很 多 方面 已 经 取得 了 突破 ， 如 关键 机 械 单元 、 基 本 行走 能 力 、 整 体 运 
动 、 动 态 视 觉 等 ,但 是 离 我 们 理想 中 的 要 求 还 相去 其 远 ， 还 需要 在 拟人 机 器 人 思维 和 学 习 能 
力 、 与 环境 的 交互 、 躯 体 结构 和 四 肢 运 动 、 体 系 结构 等 方面 进行 更 进一步 的 研究 。 研 制 与 人 
类 外 观 特 征 类 似 ， 具 有 人 类 智能 、 灵 活性 ， 并 能 
够 与 人 交流 ,不断 适应 环境 的 拟人 机 器 人 一 直 是 
人 类 的 梦想 之 一 。 

1. 躯体 结构 和 四 肢 运 动 

毫 无 疑问 ， 拟 人 机 器 人 行动 的 多 样 性 、 通 用 
性 和 必要 的 柔性 是 “智能 ”实现 的 首要 因素 。 它 
是 保证 拟人 机 器 人 可 塑性 和 与 人 交流 的 前 提 。 拟 
人 机 器 人 的 结构 则 决定 了 它 能 不 能 为 人 所 接受 ， 
而 且 也 是 它 像 不 像 人 的 关键 。 拟 人 机 器 人 必须 拥 
有 类 似 人 类 上 上 肢 的 两 条 机 械 臂 。 这 样 不 仅 可 以 满 
足 一 般 的 机 器 人 操作 和 需求， 而 且 可 以 实现 双 臂 协 
调控 制 和 手指 控制 以 实现 更 为 复杂 的 操作 ， 如 图 
1-26 所 示 。 拟 人 机 器 人 要 具有 完成 复杂 任务 所 需要 
的 感知 活动 ， 还 要 在 已 经 完成 过 的 任务 重复 出 现 
时 要 像 条 件 反射 一 样 自然 地 做 出 反应 。 

2. 与 环境 的 交互 

拟人 机 器 人 与 环境 相互 影响 的 能 力 依赖 于 其 富 于 表现 力 的 交流 能 力 ， 如 肢体 语言 、 思 维 
和 意识 的 交互 。 目 前 ， 机 器 人 与 人 的 交流 仅 限 于 固定 的 几 个 词句 和 简单 的 行为 方式 ， 其 主要 
原因 是 : 

1) 大 多 数 拟人 机 器 人 的 信息 输入 传感器 是 单 模型 的 。 

2) 部 分 应 用 多 模型 传感器 的 系统 没有 采用 对 话 的 交流 方式 。 

3) 对 输入 信息 的 采集 仅 限 于 固定 的 位 置 ， 比 如 图 像 信息 ， 照 相机 往往 没有 多 维 视角 ， 
信息 的 深度 和 广度 都 难以 保证 ， 准 确 性 下 降 。 

3. 体系 结构 

拟人 机 器 人 的 体系 结构 是 定义 机 器 人 系统 各 组 成 部 分 之 间 相 互 关 系 和 功能 分 配 ， 确 定单 


图 1-26 拟人 机 器 人 的 躯体 结 校 
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处 理 和 控制 系统 的 总 体 结构 。 如 果 说 机 器 人 的 自治 能 力 是 拟人 机 器 人 的 设计 目标 ,那么 体系 
结构 的 设计 就 是 实现 这 一 目标 的 手段 ， 如 图 1-27 所 示 。 现 在 拟人 机 器 人 的 研究 系统 追求 的 
是 采用 某 种 思想 和 技术 ， 从 而 实现 某 种 功能 或 达到 某 种 水 平 。 所 以 其 体系 结构 各 有 不 同 ， 往 
往 就 事 论 事 。 解 决 体系 结构 中 的 各 种 问题 ， 并 提出 具有 一 定 普遍 指导 意义 的 结构 思想 无 疑 具 
有 重要 的 理论 和 实际 价值 ， 这 是 摆 在 我 们 面前 的 一 项 长 期 而 艰巨 的 任务 。 


图 1-27 ”拟人 机 器 人 的 串 行 功能 分 解体 系 结构 


4. 思维 和 学 习 能 力 

现 有 拟人 机 器 人 系统 的 主要 缺陷 是 对 环境 的 适应 性 和 学 习 能 力 的 不 足 。 机 咒 人 智能 来 源 
于 与 外 界 环 境 的 相互 作用 ， 同 时 也 反映 在 对 作业 的 独立 完成 度 上 。 机 器 人 学 习 控 制 技术 是 实 
现 类 人 机 天 人 在 结构 和 非 结 构 环 境 下 实现 智能 化 控制 的 一 项 重要 技术 。 但 是 由 于 受到 传 感 噩 
噪声 、 随 机 和 运动、 在 线 学 习 方式 以 及 训练 时 间 的 限制 ， 学 习 控 制 的 实时 性 还 不 能 令 人 满意 ， 
仍 需要 研究 和 开发 新 的 学 习 算 法 、 学 习 方式 ， 以 不 断 完 善 学 习 控 制 理论 和 相应 的 评价 理论 。 
目前 针对 机 器 人 学 习 控 制 的 研究 ， 大 都 停留 在 试验 室 仿真 的 水 平 上 。 

拟人 机 器 人 具有 人 的 外 观 ， 可 以 适应 人 类 的 生活 和 工作 环境 ， 帮 助人 类 完成 各 种 作业 ， 
并 可 以 在 很 多 方面 扩展 人 类 的 能 力 ， 在 服务 、 医 疗 、 教 育 、 娱 乐 等 多 个 领域 都 将 得 到 广泛 的 
应 用 。 在 人 类 的 历史 中 ， 兽 经 因为 我 们 制造 机 器 的 局 限 性 ， 使 得 我 们 不 得 不 去 适应 机 器 ， 而 
现在 我 们 要 让 机 融 来 适应 我 们 ， 这 就 是 拟人 机 融 人 的 未 来 发 展 趋势 。 


1.5 相关 参考 资料 


1.5.1 学 术 会 议和 期 刊 


专门 的 拟人 机 器 人 学 术 会 议和 期 刊 作为 研究 工作 总 结 的 学 术 论 文 除 见 于 一 般 的 机 器 人 会 
议和 期 刊 外 ， 自 2000 年 起 由 IEEE2RAS/RSJ 召开 的 《JInternational Conference on Humanoid 
Robots》 和 上 自 2004 年 起 出 版 的 《International Journal of Humanoid Robotics》 季刊 提供 了 专门 
的 园地 。 


1.5.2 网 站 


1) 韩国 拟人 机 需 人 网 站 : Android world | EB/OL]. http: //www. androidworld. com/ 
index. html 


24 


2) Honda. Asimo : the Honda humanoid robot Asimo [ EB ZOL ]. http: //world. honda. 
com/ ASIMO/ 

3) QRIO [EB/OL]. http: //www. sony. net/SonyInfo /QRIO/top | nf. html 

4) Fujitsu. Services & products, humanoid robot HOAP22 | EB /OL]. http: //www. automa- 
tion. fujitsu. com/er/ products/ products09. html 

5) Kondo [ EB/OL]. http: //www. kondo2robot. com/index. html 

6) Speecys-products for futuristic entertainment [ EB/OL ] 

http: //www. speecys. com/products. html£robotkit 

7) Robogarage, KyotoUniversity, Chroino [ EB/OL ] 

http: //www. eonet. ne. jp/ —-robogarage/english/robo/chroino. html 

8) Robot labs [EB/OL]. http: //www. robot2labs. jp/top. html 

9) MCLab [EB/OL]. http: //ohzlab. kaist. ac. kr/ robot/KHR23 intro. html 

10) 北京 科技 大 学 机 恬 人 网 站 : www. aprobot. com 


1.6 小 结 


本 章 详细 介绍 了 机 器 人 的 发 展 史 ， 从 第 一 台 可 控制 的 机 械 手 到 现在 的 双 足 机 器 人 经 历 了 
漫长 的 时 期 ， 但 机 器 人 越 来 越 朝 着 智能 化 和 拟人 化 的 方向 发 展 。 还 介绍 了 机 器 人 的 定义 、 机 
器 人 的 分 类 、 机 顺 人 三 定律 、 机 器 人 技术 及 发 展 方向 、 机 器 人 系统 理论 ， 同 时 还 对 日 本 、 压 
国 等 外 国 及 国内 对 机 器 人 的 研究 概况 做 了 详尽 的 介绍 ， 提 出 了 研究 机 融 人 的 科学 意义 。 
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2.1 概述 


双 足 步行 机 器 人 理论 与 技术 是 一 个 多 学 科 集 成 的 研究 领域 ， 涉 及 智能 控制 〈 其 中 主要 
包括 位 置 与 姿态 的 稳定 性 控制 、 和 鲁 棒 欣 制 ) 、 行 为 步 态 的 自动 生成 方法 、 和 谐 人 机 交互 理 
论 、 人 工 智能 与 人 工人 情感 理论 方法 等 多 个 方面 。 下 面 介绍 儿 个 主要 研究 内 容 。 

(1) 稳定 性 与 控制 ”稳定 性 与 控制 策略 是 双 足 步行 机 器 人 技术 的 关键 ， 也 是 各 国学 者 
研究 的 焦点 。 具 体 主要 有 双 足 运动 的 动态 稳定 与 控制 机 理 、 双 足 步 行 运 动 的 固有 重 棒 性 机 
理 、 实 时 步 态 规划 与 控制 等 几 个 方面 。 只 有 解决 了 这 些 问 题 ， 双 足 步 行 机 器 人 才能 实现 自 
然 、 顺 畅 地 行走 ， 从 而 更 好 地 完成 任务 。2006 年 10 月 在 中 国 苏州 举行 的 机 器 人 大 赛 上 ， 所 
展 出 的 双 足 步行 机 器 人 已 经 具有 较 好 的 稳定 性 ， 不 但 具有 顺畅 的 行走 能 力 ， 而 且 在 不 慎 摔 倒 
时 还 能 够 独立 地 站 立 起 来 继续 行走 。 

(2) 开发 新 型 关节 驱动 器 ” 双 足 步行 机 器 人 的 自由 度 是 其 完成 动作 质量 的 保证 ， 自 由 
度 越 多 ， 其 动作 越 协调 、 顺 畅 。 目 前 研制 的 双 足 步行 机 器 人 自由 度 最 少 的 也 有 十 几 个 ， 最 多 
的 达到 几 十 个 。 自 由 度 增 多 的 同时 ， 对 驱动 器 的 要 求 也 越 来 越 高， 已 不 局 限于 传统 的 几 种 方 
式 ， 形 状 记 忆 合金 驱动 、 压 电 陶 次 驱动 等 方式 逐渐 应 用 到 机 器 人 领域 ， 这 些 驱 动 方式 以 驱动 
速度 快 、 负 载 能 力 强 等 特点 已 经 逐渐 取代 了 传统 的 驱动 方式 。 

(3) 改进 人 机 接口 设计 机 器 人 要 与 人 类 共存 并 合作 ,做 人 类 做 不 到 的 事 ， 开 拓 机 动 
性 的 新 领域 ， 从 而 对 人 类 社会 产生 附加 价值 ， 而 并 不 是 完全 取代 人 。 目 前 ， 双 是 步行 机 器 人 
还 不 能 摆脱 人 的 控制 而 独立 工作 ， 因 此 良好 的 人 机 协调 系统 在 机 器 人 的 工作 中 将 起 到 非常 重 
要 的 作用 。 

(4) 双 足 步行 机 器 人 行为 发 生 顺 ”一 个 机 器 人 行为 的 展示 ， 主 要 取决 于 设计 者 对 机 天 
人 行为 的 规范 和 控制 方法 。 实 现 机 器 人 控制 的 方法 有 很 多 种 ， 例 如 火星 漫步 者 号 利用 的 是 
“行为 基础 控制 ”方法 ,通过 了 两 种 方式 来 实现 “行为 基础 控制 ”: 一 个 是 “模糊 逻辑 ”， 
男 一 个 是 “神经 网 络 ”"。 这 两 部 分 的 主要 区 别 为 ， 应 用 “模糊 逻辑 ”可 以 通过 现 有 的 、 不 断 
丰富 更 新 的 知识 来 完成 任务 ， 而 应 用 “神经 网 络 ” 可 以 从 零 起 步 ， 随 着 时 间 的 推移 逐步 实 
现 知识 的 学 习 和 累积 。 

机 器 人 的 行为 是 一 个 非常 复杂 的 概念 ， 它 建立 于 人 工 智能 、 人 工 心理 等 学 科 基础 之 上 。 
而 现在 所 研究 的 机 器 人 还 不 具有 “思考 ”的 功能 ， 也 就 是 说 ， 这 个 双 足 步行 机 顺 人 所 完成 
的 所 有 动作 都 是 根据 我 们 提供 的 动作 数据 进行 的 。 那 么 如 何 产生 这 些 动作 的 数据 呢 ? 这 就 是 
所 谓 行 为 发 生 顺 需要 解决 的 问题 。 
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2.2. 双 足 步行 机 器 人 相关 理论 与 方法 的 形成 及 发 展 


从 第 一 台 双 足 步 行 机 器 人 诞生 到 现在 ， 双 足 步行 机 器 人 的 理论 及 方法 经 历 了 一 个 长 期 组 
慢 的 发 展 过 程 。 


2.2.1 稳定 性 与 控制 方法 


1. 传统 有 动力 驱动 机 器 人 

双 足 步行 机 器 人 的 研究 始 于 20 世纪 60 年 代 ， 在 1968 年 ， 美国 通用 公司 的 R. Smosher 
试制 了 一 台 名 为 “Rig” 的 操纵 型 双 足 步行 机 器 人 ， 揭 开 了 双 足 步行 机 器 人 研究 的 序幕 。 但 
该 机 器 人 只 有 咖 和 髋 两 个 关节 ， 操 纵 者 靠 力 反馈 感觉 来 保持 机 器 人 的 平衡 。 

1968 ~ 1969 年 ， 南 斯 拉夫 的 著名 科学 家 M. Vukobratovie 提出 了 一 种 重要 的 研究 双 足 步 
行 机 器 人 的 理论 ， 即 零 力矩 点 (ZMP) 稳定 判 据 ， 并 研制 出 世界 上 第 一 台 真 正 意义 的 双 足 
步行 机 器 人 。 随 后 各 国 的 学 者 和 研究 机 构 纷 纷 展开 双 足 步行 机 器 人 的 研究 工作 。 

日 本 早稻 田 大 学 的 双 足 机 器 人 研究 始 于 1968 年 ， 该 大 学 的 加 了 藤 一 郎 教授 所 领导 的 课题 
组 相继 研制 了 WL 系列 、WABIAN 系列 双 足 机 器 人 。 最 新 的 研究 成 果 为 WL-16 和 WABIAN-2 
机 器 人 ，WL-16 机 器 人 腿 部 采用 一 对 6 自由 度 的 并 联机 构 。 由 于 并 联机 构 刚 度 高 ， 许 多 金属 
部 件 用 聚 乙 烯 树脂 代 蔡 ， 齿轮、 电动 机 等 重量 都 得 以 减轻 ， 可 以 在 不 平 的 地 面 上 稳定 行走 。 
本 田 的 ASIMO 机 器 人 通过 事先 预测 到 下 上 肢 转 弯 后 重心 向 外 侧 倾 斜 多 少 等 重心 变化 ， 可 以 使 
得 从 直行 改 为 转弯 时 的 步行 动作 变 得 连续 流畅 。 而 索尼 的 QRIO 机 器 人 在 设计 的 过 程 中 ， 将 
此 前 的 用 于 步行 的 算法 中 增加 了 可 即时 控制 机 器 人 的 跳跃 方向 和 在 空中 时 可 保持 平衡 状态 的 
姿势 控制 等 的 算法 。 

但 是 ,传统 有 动力 驱动 机 器 人 不 能 够 动力 平衡 ， 它 的 行走 是 预先 编 好 程序 的 ， 如 果 你 让 
它 在 同样 一 个 地 方 走 两 次 ， 它 在 第 二 次 会 将 它 的 脚 放 在 与 第 一 次 同样 位 置 上 。 当 然 前 提 是 地 
面 要 坚固 并 有 旦 平整。 而 且 ， 动 力 驱 动 双 足 行走 机 器 人 能 量 消耗 大 ， 这 个 问题 一 直 是 研究 者 考 
虑 的 重点 。 

2. 被 动 动力 行走 机 器 人 

在 任何 一 个 特定 时 刻 的 行走 过 程 中 ， 我 们 人 类 不 得 不 考虑 (或 者 至 少 你 的 身体 这 样 做 
Y) 落脚 的 方向 ， 将 脚 放 在 正确 的 位 置 ， 使 你 能 够 治 你 想 的 方向 运动 。 对 我 们 而 言 ， 实 现 
这 个 过 程 很 容易 ， 但 是 求解 这 个 问题 很 困难 。 当 机 需 人 脚 落下 时 ， 意 味 着 它 的 重心 并 不 在 脚 
(或 两 脚 ) 的 中 间 ， 偏 差 增长 很 快 。 如 果 机 器 人 的 不 平衡 达到 几 厘 米 时 ， 就 不 太 可 能 恢复 
了 ， 因 为 也 不 能 通过 快速 移动 肢体 进行 补偿 。 像 人 一 样 高 的 东西 会 非常 迅速 、 无 法 挽救 地 失 
去 平衡 。 

美国 航空 工程 师 Tad McGeer Æ 1989 年 提出 一 个 新 的 理论 ， 完 全 不 用 驱动 也 不 用 控制 的 
机 器 人 也 能 够 实现 稳定 的 步行 运动 ， 进 而 提出 了 “被 动 动力 步行 ”概念 。 动 力 平衡 方式 行 
走 ， 落 脚 实际 上 是 经 过 控制 的 ， 使 得 机 器 人 的 行走 看 起 来 相当 平稳 。 此 后 许多 学 者 对 被 动 动 
力行 走 机 器 人 进行 了 深入 的 研究 ， 并 且 研 制 出 被 动 动力 机 器 人 样机 。2005 年 2 H 21 日 召开 
的 第 171 届 美 国 科学 促进 会 的 年 会 上 ， 由 美国 康 奈 尔 大 学 、 麻 省 理工 学 院 和 和 荷兰 代 和 尔 夫 特 理 
工大 学 的 科学 家 分 别 组 成 的 研究 小 组 ， 展 示 了 他 们 研制 出 的 能 以 人 类 步 态 直 立行 走 的 被 动 动 
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力行 走 机 器 人 ， 被 认为 代表 了 当前 被 动 动力 机 器 人 研究 的 最 新 成 果 。 

被 动 动力 行走 机 器 人 内 置 多 个 传 感 咒 ， 使 其 能 在 20min 内 学 会 像 人 一 样 走路 。 传 感 器 
能 以 200 次 /s 的 速度 测量 机 器 人 每 个 动作 的 倾斜 度 和 速度 ， 然 后 向 其 他 电动 机 下 达 新 指 
令 来 调节 身体 姿势 。 传 感 器 还 指示 制动器 控制 机 器 人 脚 趴 上 弹簧 的 压力 ， 使 其 整体 平稳 
向 前 。 每 走 一 步 ， 制 动 参数 都 会 有 所 改变 ， 所 以 机 器 人 可 以 在 任何 路 面 上 走路 ， 并 调节 
走路 的 姿势 。 

被 动 动力 步行 机 器 人 的 最 大 优点 在 于 ， 能 量 消耗 低 却 能 够 实现 像 人 一 样 有 自然 的 步 态 。 
已 经 得 到 了 国外 众多 学 者 的 深入 人 研究， 并 取得 了 巨大 的 成 果 。 但 当前 对 被 动 动力 步行 机 器 人 
的 研究 还 不 成 熟 ， 如 稳定 性 、 倒 行 等 还 需要 进一步 的 深入 研究 。 


2.2.2 双 足 步行 机 器 人 行为 发 生 方 法 


人 的 行为 动作 多 种 多 样 ， 而 机 器 人 的 行为 是 一 个 非常 复杂 的 概念 ， 它 建立 于 人 工 智 能 、 
人 工 心理 等 学 科 基础 之 上 。 目 前 双 足 步行 机 器 人 所 能 做 的 动作 都 是 人 们 根据 人 的 各 种 动作 纺 
写 并 调试 出 来 的 ， 所 以 现在 双 足 步行 机 器 人 还 不 具有 “思考 ”的 功能 ， 也 就 是 说 ， 根 据 我 
们 提供 的 动作 数据 ， 这 个 双 足 步行 机 器 人 才能 完成 所 有 动作 。 那 么 如 何 产生 这 些 动作 的 数据 
呢 ? 这 就 是 所 谓 行为 发 生 融 需要 解决 的 问题 。 

所 谓 行 为 数据 库 就 是 一 个 存储 了 机 器 人 基本 动作 单元 的 数据 库 。 从 一 个 特定 的 动作 分 
析 ， 一 个 动作 是 由 若干 个 关键 帧 动作 组 成 的 ， 可 以 将 一 些 关 键 帧 作为 动作 单元 保存 起 来 ， 运 
行 时 ， 可 根据 不 同 的 动作 选择 出 不 同 的 关键 帧 ， 拼 凑 出 一 个 完整 的 动作 。 把 一 些 简单 的 动作 
通过 不 同 的 组 合 可 以 得 到 一 些 复杂 而 有 意义 的 动作 。 

机 需 人 的 行为 是 一 个 非常 宽泛 的 概念 ， 它 受到 多 个 学 科 的 影响 ， 特 别 是 人 工 智能 学 科 的 
发 展 对 机 天 人 的 行为 有 着 非常 重要 的 作用 和 意义 。 


2. 2.3 人 机 接口 方法 


Fl 20 世纪 80 年 代 开 始 凯 起 的 各 种 应 用 背景 下 服务 于 人 类 的 机 融 人 理论 人 研究 及 应 用 技术 
(RT), ， 是 人 类 在 制造 业 领 域 、 信 息 技术 领域 、 认 知心 理学 领域 等 多 学 科 共 同 进步 的 一 个 重 
要 里 程 碑 。 融 合 多 学 科 领 域 的 人 与 机 器 人 交互 及 共存 机 制 和 技术 是 服务 机 器 人 研究 内 容 的 重 
要 组 成 部 分 ， 是 在 时 间 、 空 间 坐 标 系 上 感知 、 决 策 、 规 划 、 协 同 、 行 为 等 多 种 理论 研究 和 分 
析 方 法 的 有 机 融合 。 一 般 来 说 ， 人 与 机 器 人 和 谐 共 存 的 研究 主要 集中 在 交互 过 程 中 多 种 模式 
状态 分 析 和 理解 的 方法 及 实现 等 方面 ， 如 生物 特征 信息 提取 、 多 模 态 信息 融合 、 机 电 系统 协 
同 控制 理论 与 方法 ， 以 及 软 硬 件 协同 设计 技术 等 "] 。 由 于 交互 过 程 中 的 内 容 是 多 种 多 样 的 ， 
每 一 种 类 型 应 用 背景 下 又 有 各 自 的 特点 ， 对 任意 类 型 内 容 的 人 与 机 器 人 交互 技术 研究 是 一 件 
非常 困难 的 事情 ， 因 此 往往 针对 特定 应 用 和 利用 专业 领域 知识 对 给 定 类 型 的 人 与 机 器 人 交互 
及 共存 中 的 问题 进行 分 析 、 理 解 和 实现 方法 等 方面 的 研究 ”。20 世纪 90 年 代 初 及 本 世纪 初 
期 的 近 十 余年 中 ， 研 究 者 们 对 人 与 机 器 〈 机 器 人 人、 计算机 等 ) 的 交互 过 程 中 多 种 状态 分 析 、 
理解 和 实现 等 进行 了 大 量 的 研究 。 近 几 年 来 ， 针 对 在 典型 背景 下 的 拟人 机 器 人 社交 能 力 的 理 
论 研 究 和 应 用 技术 逐渐 成 为 研究 热点 ， 研 究 认 知 与 交互 、 情 绪 与 交互 的 关系 正在 成 为 该 领域 
的 前 沿 问题 引 。 这 主要 是 由 于 拟人 机 器 人 的 外 貌 、 表 情 、 语 言 、 肢 体 行为 对 人 类 用 户 来 说 
至 关 重 要 ， 因 此 对 拟人 机 器 人 的 需求 推动 着 该 方向 研究 的 发 展 。 男 一 方面 ， 拟 人 机 絮 人 与 人 
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类 用 户 在 共存 与 交互 过 程 中 信息 的 认 知 特征 和 情绪 特征 的 不 确定 性 和 多 样 性 等 因素 ， 吸 引 着 
越 来 越 多 的 研究 者 投入 到 这 一 领域 1 。 

从 研究 机 构 方面 来 看 ， 早 在 20 世纪 70 年 代 日 本 提出 了 “感性 工学 (Kansei Engingeer- 
ing)” 的 概念 ， 就 是 将 感知 、 认 知 科学 与 相关 应 用 领域 结合 起 来 的 基础 理论 与 应 用 技术 ， 是 
在 认 知 科学 的 基础 上 ， 通 过 分 析 人 类 的 感觉 、 知 觉 等 信息 特征 ， 把 人 类 所 特有 的 认 知 需要 加 
人 到 商品 设计 、 制 造 中 去 。 它 是 一 门 从 工程 理论 科学 的 实现 角度 ， 能 给 人 类 带 来 喜悦 和 满足 
的 商品 制造 的 技术 科学 。 在 文部 省 (日 本 中 央 政 府 行政 机 关 ， 全称 “文部 科学 省 ”) 主导 
下 ，20 世纪 90 FRAR, 日 本 各 个 学 术 领 域 积 极 引 入 感性 工学 的 观念 ， 尤 其 在 诸如 机 右 人 
科学 与 技术 、 人 工 智能 等 学 科 ' 沾 。 如 20 世纪 90 年 代 日 本 的 索尼 公司 ， 以 此 为 基础 研制 出 
AIBO 狗 机 需 人 ， 拥 有 先进 的 性 能 和 品质 ， 并 且 是 第 一 个 实现 规模 商品 化 的 宠物 机 器 人 ， 为 
有 社会 交互 能 力 的 机 需 人 及 相关 的 研究 打开 了 实用 的 空间 。 其 后 大 量 的 宠物 机 器 人 不 断 涌 
现 ， 其 共同 特点 是 对 外 界 刺激 有 反应 能 力 ， 能 同 儿 童 进 行 生 动 的 交流 。 这 种 交流 除了 语言 ， 
还 有 面部 表情 、 语 调和 身体 姿态 等 '"。 而 随后 NEC 公司 所 开发 的 PaPeRo 儿童 家 用 机 器 人 具 
有 了 听觉、 视觉， 是 个 有 个 性 、 有 表情 的 小 型 机 带 人 ， 是 一 个 可 以 与 之 一 块 生活 、 能 记 住 小 骇 
的 喜好 、 让 每 个 人 都 能 在 不 知 不 觉 间 享受 相互 交流 所 带 来 的 好 处 的 “伴侣 ”， 是 NEC 开发 
的 “未 来 家 庭 的 无 键盘 计算 机 ”。 它 具有 散步 模式 和 对 话 模式 ， 在 没 人 与 之 对 话 时 进入 散步 
模式 ， 可 以 在 房间 随意 散步 。 而 在 看 到 有 小 孩 时 即 进 入 对 话 模式 ， 可 与 儿童 交流 。 同 时 能 识 
别 约 650 个 单词 ， 能 说 3000 句 话 ， 能 辨认 人 的 脸 。 可 以 不 需 操 作 键 盘 ， 一 边 与 之 对 话 ， 一 
边 进 行 许多 其 他 的 工作 ， 如 上 网 、 收 发 邮件 、 接 收 信息 ， 自 动 传达 必要 的 信息 等 ， 利 用 它 的 
摄 录像 功能 ， 在 孩子 们 之 间 传 话 ; 能 够 与 儿童 猜 这 语 、 跳 舞 、 叫 人 起 床 、 琐 控 电 视 等 …” 。 
从 中 不 难看 出 ， 正 是 以 “感性 工学 ”的 技术 和 方法 为 核心 ， 人 类 用 户 与 机 器 人 之 间 可 以 进 
行 快 乐 和 舒适 的 交流 。 

日 本 大 阪 大 学 的 石 黑 浩 教授 研制 的 Ac-troid 机 器 人 能 用 坐姿 与 人 类 交流 。“ 她 ”全 身 安 
装 了 31 个 动作 器 和 11 个 触觉 传感器 ， 有 拟人 的 眼球 、 了 睫毛 、 会 劲 的 嘴唇 和 人 造 上 肌肉， 具备 
拟人 表情 ， 能 听 懂 4 万 多 个 中 文 、 英 文 、 日 文 和 韩文 语句 ， 并 配备 适合 于 2000 多 种 答案 的 
面部 表情 ， 可 以 容纳 更 多 的 元 部 件 ， 做 出 更 复杂 的 动作 。 石 黑 浩 教授 应 用 认 知 心理 学 有 关 理 
论 ， 将 基于 行为 主义 的 机 制 与 人 工 智能 联系 起 来 ， 形 成 了 自己 独特 的 交互 技术 和 方法 ， 并 借 
助 奇异 谷 理论 作为 评价 方法 ， 使 得 研制 的 Ac-troid 机 器 人 能 用 坐姿 通过 多 种 语言 、 丰 富 的 表 
情 、 恰 当 的 手势 等 方式 与 人 类 进行 自然 、 友 好 的 交流 "| 。 

日 本 早稻田 大 学 开发 的 儿童 玩 伴 机 器 人 有 视觉 、 上 听觉 、 触 党 和 嗅觉 传感器 来 感知 外 界 刺 
激 信 和 号。 根据 所 建立 的 儿童 大 脑 结构 化 模型 ， 通 过 外 部 和 内 部 的 刺激 相应 地 改变 其 情绪 状 
态 ， 而 后 用 多 种 方式 表达 出 来 ， 并 通过 非 线性 计算 所 产生 的 内 部 钟 来 表述 心境 矢量 的 激活 成 
分 。 

美国 斯 坦 福 大 学 传播 研究 所 的 两 位 教授 克利 福 德 . 纳 斯 和 和 拜 伦 . 里 弗 斯 ( Clifford 
Nass & Byron Reeves) 针对 人 与 机 器 人 的 交流 问题 进行 了 一 系列 研究 ， 通 过 理论 研究 与 实 
验 分 析 得 出 如 下 结论: 人 与 机 器 间 的 联系 有 自然 性 和 社会 性 ， 在 人 机 交互 中 所 需要 解决 
的 问题 同人 和 人 交流 中 的 是 一 致 的 ， 关键 就 是 赋予 机 器 人 “基于 人 类 认 知 心理 的 情感 智 
fE” REJ, 
美国 麻 省 理工 学 院 (MIT) 所 研制 的 Kismet 机 器 人 ， 通 过 所 建立 的 环境 、 内 部 刺激 和 行 
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为 动作 的 认 知 心理 模型 ， 对 外 界 输入 的 刺激 和 内 部 需要 进行 综合 判断 ， 从 而 引起 表现 行为 的 
各 种 变化 。 具 有 与 儿童 用 户 相似 的 行为 方式 和 能 力 ， 比 如 模仿 父母 与 孩子 之 间 表 示人 情绪 状态 
的 反馈 方式 ， 小 孩 向 父母 表达 需求 和 愿望 的 方式 ， 以 及 儿童 自我 学 习 与 人 和 环境 交流 的 方式 
等 。 

德国 莫 尼 黑 大 学 所 研制 的 EDDIE 交互 机 器 人 ， 这 些 执行 机 构 根 据 特定 的 人 脸 运 动 编码 
系统 来 设置 ， 每 个 表情 状态 通过 数学 映射 算法 将 计算 出 的 结果 作为 给 定 信号 来 驱动 执行 机 构 
进行 相应 的 表情 合成 ， 并 在 与 儿童 的 交流 测评 中 ， 得 到 了 比较 满意 的 结果 ” 。 

英国 赫 特 福特 大 学 的 研究 者 将 信息 科学 、 认 知心 理学 等 多 学 科 结 合 ， 在 人 与 机 器 人 交互 
过 程 中 采用 生物 启发 式 的 情感 建 模 ， 并 引入 了 个 性 的 概念 ， 包 括 感知 个 性 和 表达 个 性 。 其 
中 ， 感 知 个 性 决定 刺激 如 何 影响 机 器 人 情感 状态 ， 表 达 个 性 则 影响 机 器 人 表情 和 颈 部 运动 。 
将 此 模型 算法 应 用 于 实际 的 交互 过 程 之 中 。 根 据 隐 马尔 可 夫 等 随机 统计 模型 建立 起 语言 模型 
和 声学 模型 ， 并 由 此 获得 语言 辨识 引擎 ， 同 时 通过 基于 人 类 声 道 的 有 源 滤波 模型 ， 实 现 了 语 
音 合成 系统 ， 并 较 好 地 完成 了 与 儿童 用 户 之 间 的 语言 交流 。 另 外 ， 还 较为 广泛 地 抽样 调查 了 
儿童 对 于 不 同形 态 的 机 器 人 的 认 知 方式 ， 并 得 到 了 一 些 有 意义 的 结果 [1 。 

韩国 高 级 科学 与 技术 研究 院 与 美国 汉 森 机 器 人 公司 合作 研制 的 HUBO DLRA, RAE 
真 的 人 脸 、 身 高 137cm 、 体 重 57kg， 全 身 具 有 66 个 自由 度 ， 通 过 非 线性 状态 空间 的 统计 学 
模型 及 表情 合成 技术 ， 可 以 表达 出 喜悦 、 愤 把 、 悲 伤 等 几 种 典型 的 表情 ”1 ， 并 在 相应 展览 
会 中 ,与 儿童 进行 有 关 科 普 方面 的 交流 ， 取 得 了 较 好 效果 。 

国内 对 这 项 技术 的 研究 起 步 较 晚 ， 我 国 973 863, “十 五 ”计划 均 将 人 机 交互 列 为 主要 
内 容 。 中 国 科学 院 软件 研究 所 人 机 交互 方法 及 智能 信息 处 理 实验 室 是 最 早 开始 多 模 态 人 机 交 
互 研究 和 开发 的 单位 之 一 ， 分 别 承担 了 国家 自然 科学 基金 资助 的 重点 项 目 “ 自 然 、 高 效 和 
面向 主流 的 多 通道 ( 模 态 ) 用 户 界面 研究 ”， 国 家 重点 基础 研究 发 展 规划 (973) “虚拟 现实 
的 基础 理论 、 算 法 及 其 实现 ”中 的 子 课题 “自然 、 和 谐 的 人 机 交互 理论 和 方法 ”， 国 家 863 
高 科技 发 展 计划 “基于 笔 和 语音 的 多 模式 融合 的 人 机 交互 技术 与 应 用 ”“ 基于 多 功能 笔 式 交 
互 的 用 户 界面 "“ 基 于 PC 的 多 通道 人 -机 交互 开发 环境 " “虚拟 现 实 中 的 三 维 交互 技术 ”等 ， 
取得 了 重要 的 研究 成 果 ， 并 申请 了 相关 的 国家 专利 。 

中 国 科 学 院 软件 研究 所 和 北京 大 学 计算 机 系 、 杭 州 大 学 工业 心理 学 国家 专业 实验 室 合 
承担 的 国家 自然 科学 基金 重点 项 目 “ 多 通道 用 户 界面 研究 " ， 在 我 国 首次 对 智能 人 机 界面 中 
多 通道 交互 方式 进行 了 系统 性 的 研究 ， 对 多 通道 用 户 界面 的 模型 、 描 述 方法 及 整合 算法 、 多 
通道 用 户 界面 开发 环境 、 多 通道 用 户 界面 的 评估 等 方面 都 进行 了 一 定 的 探索 ， 取 得 了 基础 性 
的 研究 成 果 。 清 华 大 学 计算 机 系 、 中 科 院 自动 化 所 、 北 京 大 学 计算 机 系 、 中 科 院 计算 所 、 北 
京 科技 大 学 等 单位 在 智能 空间 、 笔 输入 用 户 界面 、 自 然 语言 交互 等 方向 也 都 做 了 大 量 工作 。 
中 科 院 心理 所 、 浙 江 大 学 心理 系 、 北 京师 范 大 学 心理 系 ， 也 从 认 知 心理 学 角度 对 用 户 界面 进 
行 了 研究 ， 取 得 了 许多 重要 的 研究 成 果 。 汉 王 科 技 推出 了 具有 自主 知识 产权 的 手写 汉字 识别 
系统 。 

从 技术 角度 来 看 ， 研 究 的 内 容 已 遍及 如 生物 特征 信息 提取 、 多 模 态 信息 采集 、 数 据 融 
合 、 信 息 处 理 、 机 电 系 统 协同 控制 、 软 硬件 协同 设计 技术 、 机 电 系 统 联合 振荡 的 抑制 等 诸多 


由 于 人 类 五 种 主要 的 感觉 (视觉 、 听 觉 、 嗅 觉 、 味 觉 、 触 觉 中 ， 视 觉 所 接收 的 信息 
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量 居于 首位 ， 人 体 中 70% 的 感觉 集中 来 自 眼睛 ， 因 此 视频 图 像 的 采集 、 特 征 提取 、 自 动 辨 
识 和 理解 对 交互 技术 的 研究 起 着 重要 的 作用 。 语 音 技术 同样 在 交互 过 程 中 起 着 不 可 忽视 的 作 
用 ， 主 要 包括 语音 交互 内 容 的 研究 和 语音 情感 分 析 技 术 的 研究 。 

在 人 与 机 器 人 和 谐 共存 理论 研究 及 应 用 技术 领域 ， 国 内 目前 比较 有 代表 性 的 是 哈尔滨 工 
业 大 学 研究 的 多 功能 感知 机 ， 将 人 工 智 能 与 并 行 处 理 相 结合 ， 将 智能 体 技 术 、 数 字模 拟 混 合 
计算 技术 、 并 行 计 算 技术 、 实 时 处 理 技术 以 及 语音 识别 、 表 情 识 别 、 人 脸 识 别 、 人 脸 检 测 与 
跟踪 、 文 字 识 别 、 手 语 识别 、 手 语 合成 、 表 情 合成 、 自 然 语言 理解 等 技术 有 机 结合 在 一 起 ， 
构造 一 个 可 以 研究 和 开发 包括 视觉 、 听 觉 等 人 类 语言 的 智能 机 器 人 综合 交互 平台 呈 2] ; 此 外 ， 
清华 大 学 以 认 知 心理 学 为 基础 ， 对 基于 人 工 情感 的 拟人 机 器 人 控制 体系 结构 进行 了 研究 [du] 
时 根据 其 控制 结构 具有 混合 分 层 的 特点 ， 研 究 了 典型 认 知 情感 状态 下 ， 机 器 人 与 人 类 用 户 交 
流 中 的 整个 信息 处 理 过 程 的 机 制 与 方法 。 
2.2.3.1 人 机 接口 方法 的 改进 
伴随 着 计算 机 技术 的 飞速 发 展 ， 人 机 接口 技术 也 在 不 断 改进 : 从 早期 的 穿孔 纸 带 、 面 板 
开关 和 显示 灯 等 交互 装置 ， 发 展 到 今天 的 视线 追踪 、 语 音 识别 、 感 觉 反 馈 等 具有 多 种 感知 能 
力 的 交互 装置 。 用 户 界面 的 发 展 历经 了 批 处 理 、 命 令 行 、 图 形 界 面 三 个 阶段 ， 现 在 的 研究 和 
开发 重点 已 经 放 在 了 Post-WIMP 界面 上 。 

1. 批 处 理 界 面 

在 计算 机 发 展 的 初期 ， 人 们 通过 批 处 理 的 方式 使 用 计算 机 ， 这 一 阶段 的 用 户 界 面 是 使 用 
穿孔 卡片 作为 输入 设备 ， 行 式 打印 机 作为 输出 设备 。 这 只 是 用 户 界 面 的 雏形 阶段 。 

2. 命令 行 界面 

在 20 世纪 60 年 代 中 期 出 现 的 交互 终端 和 分 时 系统 中 ， 已 经 开始 考虑 如 何 提供 给 用 户 广 
便 实用 的 界面 ， 这 些 系统 提供 了 问答 式 对 话 、 文 本 莱 单 或 者 命令 语言 进行 交互 ， 这 个 时 期 的 
人 机 界面 称 为 命令 行 界面 ( Command Line Interface, CLI), 尽管 熟练 掌握 命令 语言 后 ， 人 们 
能 够 灵活 高 效 地 操纵 计算 机 ,但 是 人 们 通常 需要 对 语言 进行 大 量 记忆 ， 在 使 用 中 很 容易 产生 
错误 。 

3. 图 形 用 户 界 面 

从 20 世纪 60 年 代 开 始 ， 由 于 超大 规模 集成 电路 的 发 展 、 高 分 辩 率 显示 器 和 鼠标 的 出 
现 ， 人 机 界面 进入 了 图 形 用 户 界 面 (Graphical User Interface, GUI) 的 时 代 。 图 形 用 户 界 面 
的 主要 特点 是 桌面 隐喻 、WIMP (Window Icon Menu Pointing Device， 窗口 、 图 标 、 菜 单 、 指 
点 设备 ) 技术 、 直 接 操纵 和 所 见 即 所 得 。 

桌面 隐喻 : 界面 隐喻 (Metaphor) 是 指 用 现实 世界 中 已 经 存在 的 事物 为 蓝本 ， 对 界面 组 
织 和 交互 方式 的 比拟 。 将 人 们 对 这 些 事 物 的 知识 (如 与 这 些 事 物 进 行 交 互 的 技能 ) 运用 到 
人 机 界面 中 来 ， 从 而 减少 用 户 必需 的 认 知 努力 。 桌 面 隐 喻 采用 办 公 的 桌面 作为 蓝本 ， 把 图 标 
放置 在 屏幕 上 ， 用 户 不 用 键入 命令 ， 只 需要 用 鼠标 选择 图 标 就 能 调 出 一 个 菜单 ， 用 户 可 以 选 
择 想 要 的 选项 。 

WIMP 技术 : WIMP 界面 可 以 看 做 是 命令 行 界面 后 的 第 二 代 人 机 界面 ， 是 基于 图 形 方式 
的 。WIMP 界面 蕴含 了 语言 和 文化 无 关 性 ， 并 提高 了 视觉 搜索 效率 ,通过 菜单 、 小 装饰 
( Widget) 等 提供 了 更 丰富 的 表现 形式 。 
直接 操纵 : 直接 操纵 用 户 界面 (Direct Manipulation User Interface) 是 Schneiderman 在 
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1983 年 提出 来 的 ， 特 点 是 对 象 可 视 化 、 语 法 极 小 化 和 快速 语义 反馈 。 在 直接 操纵 形式 下 ， 
用 户 是 动作 的 指挥 者 ， 人 处 于 控制 地 位 ， 从 而 在 人 机 交互 过 程 中 获得 完全 掌握 和 控制 权 ， 同 时 
系统 对 于 用 户 操作 的 响应 也 是 可 预见 的 。 

所 见 即 所 得 ( What you see is what you get, WYSIWYG): 也 称 为 可 视 化 操作 ， 使 人 们 可 
以 在 屏幕 上 直接 正确 地 得 到 即将 打印 到 纸张 上 的 效果 。 所 见 即 所 得 向 用 户 提供 了 无 差异 的 屏 
幕 显示 和 打印 结果 。 
2.2.3.2. 人 机 接口 方法 的 发 展 趋势 

随 着 计算 机 技术 和 人 工 智 能 技术 的 飞速 发 展 ， 可 用 于 双 足 步行 机 器 人 的 人 机 交互 技术 也 
UE SIUE JE 

1. WMP 界面 发 展 

多 媒体 计算 机 和 虚拟 实现 (VR) 系统 的 出 现 ， 改 变 了 人 与 计算 机 通信 的 方式 和 要 求 ， 
使 人 机 交互 发 生 了 很 大 的 变化 。 在 多 媒体 系统 中 继续 采用 WM 界面 有 其 内 在 的 缺陷 : MA 
多 媒体 软 、 硬 件 技术 的 发 展 ， 在 人 机 交互 界面 中 计算 机 可 以 使 用 多 种 媒体 ， 而 用 户 只 能 同时 
用 一 个 交互 通道 进行 交互 ， 因 而 从 计算 机 到 用 户 的 通信 带宽 要 比 从 用 户 到 计算 机 的 大 得 多 ， 
这 是 一 种 不 平衡 的 人 机 交互 。 

基于 WMP 技术 的 图 形 用 户 界面 ， 从 本 质 上 讲 ， 是 一 种 二 维 交互 技术 ,不 具有 三 维 直 接 
操作 的 能 力 。 要 从 根本 上 改变 这 种 不 平衡 的 通信 ， 人 机 交互 技术 的 发 展 必须 适应 从 精确 交互 
向 非 精确 交互 、 从 单 通道 交互 向 多 通道 交互 以 及 从 二 维 交互 向 三 维 交 互 的 转变 ， 发 展 用 户 与 
计算 机 之 间 快 速 、 低 耗 的 多 通道 界面 。 

可 以 看 出 在 计算 机 系统 不 同 的 发 展 阶段 中 ， 人 机 交互 模型 的 发 展 过 程 如 图 2-1 所 示 。 在 
传统 的 人 机 系统 中 ， 人 被 认为 是 操作 员 ， 只 是 对 机 器 进行 操作 ， 而 无 真正 的 交互 活动 。 在 计 
算 机 系统 中 人 还 是 被 称 为 用 户 。 只 有 在 VR 系统 中 的 人 才 是 主动 的 参与 者 。 


字符 方式 。 图 形 有 网 络 网 络 空间 


Mi EN VR 
[| (虚拟 实现 ) 
mE. 


人 机 交互 发 展 史 


图 2-1 人 机 交互 模型 的 发 展 过程 


2. 多 媒体 与 虚拟 现实 系统 的 交互 

与 传统 用 户 界面 相 比 ， 引 入 了 视频 和 音频 之 后 的 多 媒体 用 户 界 面 ， 最 重要 的 变化 就 是 
界面 不 再 是 一 个 静态 界面 ， 而 是 一 个 与 时 间 有 关 的 时 变 媒体 界面 。 人 类 使 用 语言 和 其 他 
时 变 媒 体 ( 如 姿势 ) 的 方式 完全 不 同 于 其 他 媒体 。 从 向 用 户 呈 现 的 信息 来 讲 ， 时 变 媒 体 
主要 是 顺序 呈现 的 ， 而 我 们 熟悉 的 视觉 媒体 (文本 和 图 形 ) 通常 是 同时 呈现 的 。 在 传统 
的 静止 界面 中 ， 用 户 或 是 从 一 系列 选项 中 进行 选择 (明确 的 界面 通信 成 分 ) ， 或 是 用 可 再 
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认 的 方式 进行 交互 ( 隐 含 的 界面 通信 成 分 ) 。 在 时 变 媒 体 的 用 户 界面 中 ， 所 有 选项 和 文件 
必须 顺序 呈现 。 由 于 媒体 带宽 和 人 的 注意 力 的 限制 ， 在 时 变 媒体 中 ， 用 户 不 仅 要 控制 呈 
现 信 息 的 内 容 ， 也 必须 控制 何 时 呈现 和 如 何 呈 现 。 

目前 ， 许 多 人 把 多 媒体 系统 错误 地 只 当 作 是 一 种 表现 装置 。 这 除了 对 多 媒体 的 错误 理解 
外 ， 没 有 有 效 的 多 媒体 交互 形式 也 是 目前 多 媒体 存在 的 一 大 问题 ， 因 而 多 通道 与 多 媒体 用 户 
界面 是 联系 在 一 起 的 。 

3. VR 系统 中 人 机 交互 

人 机 交互 可 以 说 是 VR 系统 的 核心 ， 因 而 ，VR 系统 中 人 机 交互 的 特点 是 所 有 软 、 硬 件 
设计 的 基础 。 其 特点 如 下 : 

1) 观察 点 (Viewpoint) 是 用 户 做 观察 的 起 点 。 

2) 导航 (Navigation) 是 指 用 户 改 变 观 察 点 的 能 

3) 操作 (Manipulation) 是 指 用 户 对 其 周围 对 象 起 作用 的 能 

4) 临 境 (Immersion) 是 指 用 户 身 临 其 境 的 感觉 ， 这 在 VR 系统 中 越 来 越 重要 。 

VR 系统 中 人 机 交互 若 要 具备 这 些 特点 ， 就 需要 发 展 新 的 交互 装置 ， 其 中 包括 三 维 空间 
定位 装置 、 语 言 理 解 、 视 觉 跟踪 、 头 部 跟踪 和 姿势 识别 等 。 多 媒体 与 VR 系统 的 人 机 交互 有 
着 某 些 共同 特点 。 首 先 ， 它 们 都 是 使 用 多 个 感觉 通道 ， 如 视觉 和 听觉 ; 其 次 ， 它 们 都 是 时 变 
媒体 。 

4. 多 通道 人 机 交互 方法 

人 机 交互 技术 是 目前 用 户 界 面 研 究 中 发 展 得 最 快 的 领域 之 一 ， 对 此 ， 各 国都 十 分 重视 。 
在 美国 国防 关键 技术 中 ， 人 机 界面 不 仅 是 软件 技术 中 的 重要 内 容 之 一 ， 而 且 是 与 计算 机 和 软 
件 技术 并 列 的 11 项 关键 技术 之 一 。 欧 盟 的 欧洲 信息 技术 研究 与 发 展 战 略 计划 (ESPRIT) 还 
专门 设立 了 用 户 界 面 技术 项 目 , 其 中 包括 多 通道 人 机 交互 界面 (MultiModal Interface for Man- 
Machine Interface) 。 保 持 在 这 一 领域 中 的 领先 ， 对 整个 智能 计算 机 系统 是 至 关 重 要 的 。 我 们 
可 以 以 发 展 新 的 人 机 界面 交互 技术 为 基础 ， 带 动 和 引导 相关 的 软 、 硬 件 技 术 的 发 展 ， 使 更 有 
效 地 使 用 计算 机 的 计算 处 理 能 力 成 为 可 能 。 

21 世纪 ， 人 机 交互 的 特点 是 多 通道 、 多 媒体 。 以 虚拟 现实 为 代表 的 计算 机 系统 的 拟人 
化 ， 以 及 以 手持 电脑 、 智 能 手机 为 代表 的 计算 机 的 微型 化 、 随 身 化 、 骨 入 化 ， 是 当前 计算 机 
的 两 个 重要 的 发 展 趋势 。 通 俗 地 讲 就 是 ， 手 机 越 来 越 大 、 电 脑 越 来 越 小 。 和 鼠标 和 键盘 为 代表 
的 GUI 技术 不 再 是 主导 ， 而 是 利用 人 的 多 种 感觉 和 动作 通道 (如 语音 、 手 写 、 姿 势 、 视 线 、 
表情 等 输入 ) ， 以 并 行 、 非 精确 的 方式 与 (可见 或 不 可 见 的 ) 计算 机 环境 进行 交互 ， 大 大 提 
高 了 人 机 交互 的 自然 性 和 高 效 性 。 

5. 语音 交互 方法 

让 计算 机 能 听 、 能 看 、 能 说 、 能 感 党 是 未 来 人 机 交互 的 发 展 方向 ， 其 中 语音 成 为 未 来 最 
被 看 好 的 人 机 交互 方式 ,语音 比 起 其 他 的 交互 方式 有 更 多 的 优势 。 最 早 的 语音 技术 因 “ 自 
动 翻译 电话 ”计划 而 起 ,包含 了 语音 识别 、 自 然 语言 理解 和 语音 合成 三 项 非常 重要 的 技术 。 
语音 识别 的 研究 工作 可 以 追溯 到 20 世纪 50 年 代 AT&T 贝尔 实验 室 的 Audry 系统 ， 此 后 研究 
者 们 逐步 突破 了 大 词汇 量 、 连 续 语音 和 非特 定 人 这 三 大 障碍 。20 世纪 90 年 代 前 期 ， 许 多 著 
名 的 大 公司 ,如 IBM, R, ATAT 和 NTT 都 对 语音 识别 系统 的 实用 化 研究 投 以 巨 资 。 让 计 
算 机 说 话 需 要 用 到 语音 合成 技术 ， 其 核心 是 文 语 转换 技术 (Text to Speech) ,语音 合成 甚至 
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已 经 应 用 到 汽车 的 信息 系统 上 ， 车 主 可 以 将 下 载 到 系统 计算 机 中 的 文本 文件 、 电 子 邮 件 、 网 
络 新 闻 或 小 说 转换 成 语音 在 车 内 收听 。 还 可 以 通过 特定 的 服务 网 站 订阅 新 闻 ， 享 受 个 性 化 的 
网 络 信息 服务 。2008 年 是 语音 技术 重要 应 用 的 一 年 ,，“ 数 字 奥 运 ” 的 目标 就 是 研发 “面向 奥 
运 多 语言 信息 服务 系统 ”， 多 语种 语音 合成 产品 是 构成 整个 服务 网 络 系 统 的 重要 组 成 部 分 ， 
这 套 系统 可 以 提供 多 语种 、 多 方言 、 多 发 言 人 、 多 语气 语调 ,并且 具备 一 定 自学 习 能 力 的 个 
性 化 语音 服务 。 

6. 眼 标 交互 方法 

交互 基本 上 都 离 不 开 用 户 的 视觉 ， 那 么 如 果 用 户 能 用 眼睛 (直接 用 大 脑 思 维 来 控制 的 
“ 脑 标 ”目前 还 太 遥 远 ) 来 操控 图 形 界 面 岂 不 是 更 方便 ? 由 此 ,“ 眼 标 ” 应 运 而 生 。2002 年 
伦敦 帝国 学 院 的 科研 小 组 花费 数 年 时 间 来 研究 人 类 眼睛 活动 与 大 脑 感知 之 间 的 关系 ， 最 终 发 
明 出 一 种 专门 用 来 捕捉 眼球 细微 动作 的 红外 线 感 应 装置 ， 被 他 们 称 为 “ 眼 标 ”。“ 眼 标 ” 能 
鉴别 眼睛 在 显示 屏 上 的 移动 和 注视 ， 如 果 电 脑 使 用 者 盯 住 屏幕 上 的 某 个 链接 图 标 1s 以 上 ， 
电脑 就 自动 打开 该 链接 ; 如 果 使 用 者 盯 住 打印 或 者 存盘 的 图 标 ， 电 脑 就 会 自动 进行 相应 的 操 
作 。 不 过 ， 人 们 眼球 运动 时 存在 的 固有 拌 动 以 及 眼睛 用 动 所 造成 的 数据 中 断 ， 就 会 干扰 信 
号 。 另 外 ， 如 果 鼠 标 器 光标 总 是 随 着 用 户 的 视线 移动 ， 可 能 会 引起 反感 ， 因 为 用 户 “ 随 便 ” 
看 着 什么 而 并 非 总 是 “意味 着 ”什么 。 理 想 情 况 是 用 户 希 望 发 出 控制 时 ， 系 统 及 时 地 处 理 
其 视线 输入 ， 而 在 相反 的 情况 下 则 忽略 其 视线 的 移动 。 让 电脑 去 理解 用 户 的 这 一 美好 愿望 还 
不 大 可 能 。 不 过 ， 科 研 人 员 仍 认为 人 类 用 眼睛 搜索 和 有 盯 住 一 个 目标 的 准确 性 远 远 超过 用 手 移 
动 鼠 标 。 


2.3 理论 难点 
双 足 步行 机 器 人 是 一 种 具有 人 的 外 形 ， 并 能 够 效仿 人 体 的 某 些 物理 功能 、 感 知 功能 及 社 


交 能 力 并 能 承袭 人 类 的 部 分 经 验 的 机 器 人 。 因 此 人 类 研究 双 足 步行 机 器 人 的 目的 是 要 创造 一 
新 型 工具 ， 它 能 在 典型 的 日 常 环 境 中 和 人 类 交流 ， 在 更 广泛 的 环境 任务 中 扩展 人 类 的 能 


因此 研究 双 足 步行 机 器 人 就 会 遇 到 许多 的 理论 难点 ， 如 人 工 智 能 、 人 工 心理 与 人 工 情 
遗传 算法 的 应 用 等 ， 只 有 攻克 这 些 难题 之 后 才能 更 好 地 研究 机 器 人 ， 造 福 人 类 。 


2.3.1 人工 智能 理论 


机 器 人 的 实际 控制 过 程 中 ， 我 们 看 到 最 多 的 应 用 还 是 PE、PD 和 PID 控制 。 传 统 控 制 
(经 典 控制 理论 和 现代 控制 理论 ) 的 主要 特征 是 基于 模型 的 控制 ， 即 首先 要 建 模 一 一 实现 对 
实际 被 控 物 理 对 象 的 数学 模型 的 建立 。 但 是 随 着 人 类 生产 力 发 展 水 平 的 提高 ， 需 要 被 控制 的 
对 象 越 来 越 复杂 。 其 复杂 性 表现 为 高 度 的 非 线 性 、 高 噪声 干 捧 、 动 态 突变 性 以 及 分 散 的 传 感 
元 件 和 执行 元 件 、 分 层 和 分 散 的 决策 机 构 、 多 时 间 尺 度 、 复 杂 的 信息 结构 等 。 这 些 复杂 性 都 
难以 用 精确 的 数学 模型 (微分 方程 或 差分 方程 来 描述 。 然 而 ， 对 这 样 复杂 系统 的 控制 性 
能 的 要 求 越 来 越 高 ， 使 得 基于 精确 模型 的 传统 控制 系统 难以 解决 。 因 此 把 人 工 智 能 的 方法 引 
人 控制 系统 ， 将 控制 理论 的 分 析 和 理论 的 洞察 力 与 人 工 智 能 的 灵活 框架 结合 起 来 ， 才 有 可 能 
得 到 新 的 认识 上 的 突破 。 智 能 控制 系统 具有 拟人 的 智能 或 仿 人 的 智能 ， 即 人 工 智能 。 这 种 智 
能 主要 表现 在 智能 决策 上 ， 能 够 有 效 地 解决 复杂 性 和 不 确定 性 的 控制 问题 。 


交 
种 
力 
感 
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模糊 控制 就 是 在 研究 人 的 控制 行为 特点 的 基础 上 发 展 起 来 的 。 对 于 无 法 构造 数学 模型 的 
被 控制 对 象 ， 让 计算 机 模仿 人 的 思维 方式 ， 进 行 控制 决策 。 人 的 控制 可 以 用 语言 加 以 描述 ， 
总 结 成 一 系列 的 条 件 语句 ， 即 控制 规则 。 运 用 微机 的 程序 来 实现 这 些 控 制 规则 ， 这 样 就 很 像 
是 人 的 思考 行为 了 。 总 之 ,模糊 控制 是 基于 专家 经 验 和 专业 领域 的 知识 ， 总 结 出 若干 条 模糊 
控制 规则 ， 构 成 描述 具有 不 确定 性 复杂 对 象 的 模糊 关系 ， 通 过 被 控 系 统 输出 误差 和 模糊 关系 
的 推理 合成 来 获得 控制 量 ， 从 而 对 系统 进行 控制 。 

模拟 人 类 大 脑 的 机 能 ， 人 们 又 创造 出 了 人 工 神经 网 络 (可 以 通过 计算 机 软件 实现 或 通 
过 大 规模 集成 化 硬件 电路 实现 ) ， 并 且 进 一 步 实现 了 神经 网 络 控 制 系统 ， 即 在 控制 系统 中 采 
用 神经 网 络 这 一 工具 对 难以 精确 描述 的 、 复 杂 的 、 非 线性 对 象 进行 建 模 或 充当 控制 器 ， 或 优 
化 计算 ， 或 进行 推理 、 故 障 诊断 等 。 神 经 网 络 控制 具有 很 强 的 逼近 非 线性 函数 的 能 力 ， 即 非 
线性 映射 能 力 。 神 经 网 络 还 具有 上 自学 能 力 、 自 适应 能 力 ， 可 以 实现 最 优化 的 决策 控制 、 神 经 
网 络 学 习 控制 、 自 组 织 控制 。 将 神经 网 络 控 制 与 模糊 控制 相 结 合 ， 可 以 实现 更 加 复杂 高 效 的 
神经 网 络 模 糊 控 制 系统 。 在 人 工 智 能 的 新 技术 不 断 出 现 及 智能 控制 的 应 用 不 断 深化 的 过 程 
中 ， 神 经 网 络 必 将 在 和 其 他 的 新 技术 相 融 合 中 发 挥 出 更 大 的 作用 。 


2.3.2 人工 心理 与 人 工 情 感 


人 工 智能 发 展 的 最 高 水 平 的 体现 就 是 现代 智能 机 器 人 。 智 能 机 器 人 要 实现 更 为 复杂 的 仿 
人 控制 ， 就 不 仅 要 使 它 具 有 人 类 的 智力 思维 模式 ， 还 需要 使 机 器 人 具有 人 类 的 情感 思维 模 
式 。 研 究 表明 ， 人 类 的 思维 决策 是 辩证 逻辑 思维 与 情感 思维 的 结合 。 情 感 思维 可 以 使 个 体 以 
最 佳 的 行为 方式 〈 即 控制 方式 ) ， 与 社会 的 其 他 成 员 ， 特 别 是 与 其 具有 情感 联系 的 某 些 人 之 
间 协 同 交 互 作用 ， 达 到 最 优化 的 效果 。 在 未 来 的 智能 机 器 人 控制 系统 中 ， 不 具备 情感 思维 模 
式 的 控制 是 难以 想象 的 ， 是 不 完备 的 。 这 就 要 求 在 机 器 人 身上 实现 仿 人 类 的 人 工 感情 思维 控 
制 。 这 一 问题 ， 牵 涉 到 机 器 人 与 人 类 之 间 的 情感 交流 以 及 机 器 人 相互 之 间 的 情感 交流 。 

人 工 智能 的 研究 发 展 已 经 达到 了 较 高 的 水 平 ， 同 时 它 的 研究 内 容 也 在 逐渐 扩展 和 延伸 。 
新 世纪 科学 研究 发 展 的 特征 是 多 学 科 交 又 ， 而 NBIC 会 聚 技 术 为 人 工 智能 的 研究 指明 了 方 
向 。 人 研究 情感 与 认 知 的 关系 需要 人 工 智 能 领域 的 专家 扩展 研究 人 工 情 感 与 人 工 心理 问题 。 要 
使 计算 机 拥有 人 工人 情感 乃 至 人 工 心 理 处 理 能 力 ， 这 一 观点 首先 是 由 人 工 智 能 创始 人 之 一 的 美 
国 麻 省 理工 学 院 人 工 智能 学 权威 明 斯 基 (Minsky) 教授 提出 的 ， 早 在 1985 年 他 就 指出 : 问 
题 不 在 于 智能 机 器 能 否 拥有 任何 情感 ， 而 在 于 机 带 实 现 智 能 时 怎么 能 够 没有 情感 。 目 前 对 这 
个 领域 的 研究 已 经 在 国内 许多 单位 展开 ， 可 以 说 ， 对 人 工 情 感 乃 至 人 工 心理 的 研究 已 经 成 为 
一 种 趋势 。 能 够 识别 人 类 的 情感 ， 能 够 了 解 和 模仿 人 类 的 心理 ， 只 有 这 样 才能 为 人 类 提供 更 
温 志 的 服务 ， 即 具有 人 工 心理 和 人 工 情感 的 机 顺 才 具有 更 加 友好 的 人 机 交互 功能 。 


2.3.3 遗传 算法 的 应 用 


近年 来 遗传 算法 得 到 迅速 发 展 。 遗 传 算法 基于 对 生物 遗传 和 进化 过 程 的 模拟 ， 使 得 人 工 
系统 具有 良好 的 自 适应 能 力 和 优化 能 力 。 遗 传 算法 提供 了 一 种 求解 复杂 系统 优化 问题 的 常用 
方法 。 因 此 将 遗传 算法 应 用 于 机 器 人 这 类 复杂 的 人 工 系统 是 顺理成章 的 事情 。 它 可 以 充分 利 
用 计算 机 的 强大 计算 能 力 对 解 空间 进行 搜索 。 

遗传 算法 (Genetic Algorithm，GA) ， 是 以 遗传 学 理论 基础 所 构造 的 一 类 搜索 算法 ， 它 
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TEE REREBE ECX E WIXETUSEREPETT Y RAIRE, ERARA IL 18 Holland 教授 在 
他 的 著作 《自然 和 人 工 系统 中 的 适应 性 》 (The Adaptability of Natural and Artificial Systerm ) 
中 将 遗传 算法 的 基本 框架 分 解 为 适应 系统 和 进化 系统 两 个 方面 。 

作为 一 种 可 用 于 复杂 系统 优化 计算 的 鲁 棒 搜 索 算法 ， 遗 传 算法 不 同 于 其 他 一 些 优化 算 
法 ， 具 有 以 下 一 些 特点 : 

(1) 对 先 验 性 知识 依赖 程度 很 低 ”主要 通过 适应 度 来 判断 所 得 候选 解 的 效果 ， 避 免 了 比 
较 复 杂 的 建 模 等 环节 ， 在 一 定 程度 上 具有 某 种 非 程 序 的 特点 和 高 度 的 自 适应 信息 处 理 能 

(2) 遗传 算法 以 决策 变量 的 编码 作为 运算 对 象 ” 传 统 的 优化 算法 往往 直接 利用 决策 变量 
的 实际 值 本 身 来 进行 优化 计算 ， 而 遗传 算法 以 决策 变量 值 的 某 种 形式 的 编码 为 运算 对 象 。 这 
种 对 决策 变量 的 编码 处 理 方式 ， 使 得 我 们 在 优化 计算 过 程 中 可 以 借鉴 生物 学 中 染色 体 和 基因 
等 概念 ， 可 以 模仿 自然 界 中 生物 的 遗传 和 进化 等 机 理 ， 也 使 得 我 们 可 以 方便 地 应 用 遗传 操作 
算 子 。 特 别 是 对 一 些 无 数值 概念 或 很 难 有 数值 概念 ， 只 有 代码 概念 的 优化 问题 ， 编 码 处 理 方 
式 更 显示 出 其 优越 性 。 

(3) 遗传 算法 直接 以 目标 函数 值 作为 搜索 信息 ”传统 的 优化 算法 不 仅 需 要 利用 目标 函数 
值 ， 而 且 往往 需要 目标 函数 的 导数 值 等 其 他 一 些 辅助 信息 才能 确定 搜索 方向 。 而 遗传 算法 仅 
使 用 由 目标 也 数值 变换 得 到 的 适应 度 函数 值 ， 就 可 确定 进一步 的 搜索 方向 和 搜索 范围 。 这 个 
特性 是 非常 有 用 的 ， 对 那些 目标 函数 无 法 求 导数 的 函数 ， 或 导数 不 存在 的 函数 优化 问题 及 组 
合 优化 问题 等 ， 应 用 遗传 算法 时 就 显得 比较 方便 ， 因 为 它 避 开 了 机 数 求 导 这 个 障碍 。 再 者 ， 
直接 利用 目标 函数 值 或 个 体 适 应 度 ， 也 使 我 们 可 以 把 搜索 范围 集中 到 适应 度 较 高 的 部 分 搜索 
空间 中 ， 从 而 提高 了 搜索 效率 。 

(4) 遗传 算法 同时 使 用 多 个 搜索 点 的 搜索 信息 ”传统 的 优化 算法 往往 是 从 解 空间 中 的 一 
个 初始 点 开始 最 优 解 的 迭代 搜索 过 程 。 单 个 搜索 点 所 提供 的 搜索 信息 毕竟 不 多 ， 所 以 搜索 效 
率 不 高 ， 有 时 其 至 使 搜索 过 程 陷于 局 部 最 优 解 。 遗 传 算法 是 从 很 多 个 体 所 组 成 的 一 个 初始 群 
体 开始 搜索 最 优 解 ， 而 不 是 从 单一 的 个 体 开始 搜索 。 

(5) 遗传 算法 使 用 概率 搜索 技术 ”很 多 传统 的 优化 算法 往往 使 用 的 是 确定 性 的 搜索 方 
法 ,在 这 种 算法 中 一 个 搜索 点 到 另 一 个 搜索 点 的 转移 有 确定 的 转移 方法 和 转移 关系 ， 这 种 确 
定性 往往 也 有 可 能 使 得 搜索 永远 达 不 到 最 优点 ， 因 而 也 限制 了 算法 的 应 用 范围 。 而 遗传 算法 
属于 一 种 自 适应 概率 搜索 技术 ， 其 选择 、 交 义 、 变 异 等 运算 都 是 以 一 种 概率 的 方式 来 进行 
的 ， 从 而 增加 了 其 搜索 过 程 的 灵活 性 。 虽 然 这 种 概率 特性 也 会 使 群体 中 产生 一 些 适 应 度 不 高 
的 个 体 ， 但 随 着 进化 过 程 的 进行 ， 新 的 群体 中 总 会 更 多 地 产生 出 优良 的 个 体 ， 实 践 和 理论 都 
已 证 明了 在 一 定 条 件 下 遗传 算法 总 是 以 概率 1 收敛 于 问题 的 最 优 解 。 当 然 ， 交 叉 概 率 和 变异 
概率 等 参数 也 会 影响 算法 的 搜索 效果 ， 所 以 如 何 选择 遗传 算法 的 参数 在 具体 应 用 时 是 一 个 比 
较 重要 的 问题 。 

随 着 计算 机 计算 能 力 的 不 断 提高 ， 遗 传 算法 在 机 器 人 控制 领域 也 得 到 了 应 用 。 


2.3.4 基于 仿生 学 原理 的 步 态 控制 


基于 仿生 学 的 双 足 步 态 研究 主要 通过 测量 和 分 析 人 类 的 步行 运 劲 ， 研 究 双 足 步行 的 基本 
原理 ， 将 得 到 的 一 些 基 本 步 态 特 征 运 用 到 双 足 步行 机 器 人 控制 当中 。 最 早 在 1901 年 英国 摄 
影 家 爱 德 沃 德 迈 布 里 奇 (Eadweard Muybridge) 通过 观察 人 类 和 40 多 种 动物 的 运动 过 程 ， 研 
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究 了 包括 马 等 8 种 动物 的 运动 步 法 ， 得 到 了 它们 的 步 态 模式 。 他 的 研究 揭示 了 动物 的 简单 步 
态 模 型 ， 开 辟 了 从 仿生 学 角度 研究 双 足 步 态 的 先河 。 随 后 将 行为 模仿 的 思想 运用 到 机 器 人 
VR 的 控制 方法 当中 ， 通 过 模仿 学 习 表 达 非 线性 动力 学 差分 方程 ， 形 成 控制 策略 ， 采 用 的 局 
部 权重 回归 算法 保证 了 学 习 的 收敛 性 。 沿 着 这 个 思路 ，1976 年 Margaria 通过 研究 人 类 不 同 
步行 运动 过 程 中 肌肉 的 电信 号 和 能 量 消耗 ,探讨 了 人 类 步行 所 需要 的 最 少 肌肉 运动 量 ， 这 为 
以 后 研究 被 动 步 态 提供 了 一 定 的 事实 依据 。 随 后 美国 南 加 州 大 学 的 Auke Ijspeert 博士 等 将 行 
为 模仿 的 思想 运用 到 了 机 器 人 VR 的 控制 方法 当中 。 通 过 模仿 学 习 表达 非 线 性 动力 学 差分 方 
程 形 成 控制 策略 ， 采 用 的 局 部 全 重 回归 算法 保证 了 学 习 的 收敛 性 。 这 种 研究 思路 也 被 日 本 本 
田 公 司 运 用 到 了 ASIMO 机 器 人 的 步 态 规划 当中 ， 通 过 离线 研究 人 类 步 态 运动 的 特性 ， 形 成 
简单 的 步 态 模式 ， 然 后 经 过 在 线 调整 误差 控制 机 器 人 最 终 步 态 。 

另 一 个 仿生 学 的 重要 贡献 是 在 大 多 数 动物 脑 组 织 中 发 现 了 控制 运动 节奏 的 中 央 模 式 发 生 
单元 (Central Pattern Generator) ， 这 促使 一 部 分 研究 学 者 尝试 在 双 足 步 态 中 应 用 这 一 结构 。 
1999 年 Williamson 用 中 央 模 式 发 生 器 控制 机 器 人 手臂 运动 完成 简单 的 杂 页 动作 ， 这 位 学 者 
还 从 人 类 步行 机 构 得 到 启示 ， 设 计 弹 性 关节 解决 双 足 步行 中 关节 冲击 问题 。Fukuoka 等 设计 
了 PD 控制 需 组 成 的 弹性 关节 ， 通 过 中 央 模 式 发 后 单元 接受 传 感 咒 输入 ， 并 将 计算 得 到 的 输 
出 角度 发 送 给 各 运动 关节 。 实 验 表 明 机 器 人 可 以 在 中 度 不 平整 地 面 行 走 ， 并 可 根据 地 面 平滑 
程度 调整 能 量 消耗 和 稳定 性 两 项 运动 指标 。 他 们 的 成 功 吸引 了 越 来 越 多 的 学 者 开始 这 一 方向 
的 研究 。 

人 体 步行 运动 的 研究 为 实现 机 器 人 步行 运动 提供 了 借鉴 和 指导 ， 对 人 类 步行 运动 的 观察 
与 记录 也 促使 人 们 了 解 和 发 现 步行 的 运动 特征 与 规律 。 在 获得 人 类 行走 数据 的 基础 上 ， 根 据 
仿生 学 思想 ， 研 究 人 员 还 沦 试 使 用 记录 的 人 类 步行 运动 数据 驱动 机 需 人 行走 。 目 前 世界 上 最 
先进 的 自主 式 拟人 机 需 人 ASIMO 就 是 在 分 析 人 类 行走 运动 的 基础 上 动态 生成 双 足 步 态 。 随 
着 测试 和 记录 手段 的 不 断 完善 ， 研 究 人 员 可 以 获得 更 加 完整 和 详细 的 步行 运动 数据 ， 由 此 提 
炼 得 到 更 加 完备 的 人 体 运 动 规律 ， 设 计 更 加 接近 人 类 步 态 的 双 是 机 器 人 步 态 。 


2.3.5 动力 学 模型 


机 器 人 学 学 术 界 对 双 足 运动 的 研究 已 有 多 年 ， 其 中 比较 好 的 和 人 门 读物 有 前 南斯拉夫 学 者 
Vukobratovic 与 美国 麻 省 理工 学 院 的 Raibert 的 著作 。 

在 过 去 的 40 多 年 里 ， 人 公司、 大学、 研究 所 开发 的 双 足 机 器 人 样机 数 以 百 计 ， 在 这 其 中 ， 
日 本 本 田 公 司 在 样机 技术 上 取得 的 进步 最 让 人 瞩目 ， 但 从 其 公开 的 录像 可 以 看 出 ， 本 田 机 器 
人 ASIMO ARMEER, (Zero Movement Point, ZMP) 稳定 判 据 规划 其 运动 ， 在 相同 的 
步 速 下 ， 与 人 类 的 行走 模式 还 有 较 大 区 别 ， 且 无 法 解释 和 实现 ZMP 稳定 判 据 以 外 的 双 足 运 
动 。 正 如 美国 麻 省 理工 学 院 腿 实验 室 的 Pratt 教授 所 说 : 本 田 公司 设计 控制 右 的 方法 无 法 解 
释 为 什么 给 定 的 轨迹 有 效 ， 也 无 法 解释 在 崎 邮 路 面 上 选择 轨迹 模式 的 内 在 机 理 。 

双 足 步行 机 器 人 要 取得 进一步 的 发 展 ， 就 必须 要 研究 双 足 运动 的 内 在 固有 特点 ， 必 须 深 
入 研究 其 稳定 性 与 控制 机 理 。 只 有 人 解释 清楚 了 这 一 系列 机 理性 问题 ， 双 是 步行 机 器 人 的 研制 
才能 有 本 质 上 的 进步 。 

双 足 行走 机 器 人 与 多 足 行 走 机 吉 人 相 比 ， 本 质 上 是 不 稳定 的 ， 而 且 控 制 更 加 困难 。 人 类 
以 其 完美 的 行走 姿态 和 稳定 性 成 为 双 足 步行 机 器 人 的 模仿 对 象 。 由 于 人 类 的 行走 与 机 器 人 的 
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行走 机 理 不 同 ， 完 全 生 搬 硬 套 地 将 人 类 行走 的 模型 应 用 到 双 足 步行 机 器 人 上 显然 是 不 行 的 。 
因此 研究 稳定 的 姿态 与 步 态 一 直 是 各 国 研 究 双 足 机 器 人 的 最 重要 的 问题 之 一 。 
2.3.5.1 动力 学 分 析 

双 足 步行 机 器 人 是 一 个 多 自由 度 的 复杂 机 械 结构 ， 其 动力 学 方程 具有 非 线 性 、 高 阶 和 强 
耦合 的 特点 ， 现 有 的 数学 模型 和 解析 算法 不 足以 得 到 完整 和 精确 的 步 态 解 。 除 可 控 的 有 驱动 
自由 度 以 外 ， 双 足 系统 脚板 与 地 面 之 间 存 在 无 驱动 的 自由 度 ， 这 个 自由 度 的 控制 对 机 器 人 的 
姿态 稳定 具有 重要 的 意义 。 最 后 双 足 步行 机 器 人 不 同 特 性 的 步 态 周 期 切换 也 是 自然 步 态 生成 
中 的 一 个 难点 。 双 是 步行 机 器 人 的 步 态 由 静态 的 双 脚 支撑 期 和 动态 的 单 脚 支撑 期 组 成 。 在 步 
行 过 程 中 ， 双 足 步 行 机 器 人 从 稳定 的 双 脚 支撑 过 渡 到 不 稳定 的 单 脚 支撑 ， 相 应 的 控制 结构 从 
闭环 切换 到 开 环 。 从 机 器 人 的 跑步 运动 我 们 可 以 看 到 ， 机 器 人 在 腾空 状态 依然 可 以 保持 动态 
平衡 ， 也 就 是 说 机 带 人 的 步行 控制 不 能 平行 地 移植 到 机 融 人 的 跑步 控制 当中 。 这 为 多 模型 系 
统 的 稳定 控制 和 平滑 控制 制造 了 更 多 的 困难 。 

双 足 步行 机 器 人 是 一 个 多 自由 度 、 多 关节 的 复杂 多 连 杆 机 构 ， 具 有 丰富 的 动力 学 特性 。 
对 双 足 步行 机 器 人 进行 动力 学 分 析 可 以 帮助 了 解 行走 运动 和 力 之 间 的 关系 ， 明 确 机 械 本 体 的 
质量 特性 、 步 行 姿态 、 步 行 速度 与 关节 力矩 的 相互 联系 ， 为 对 其 进行 力矩 控制 和 平稳 性 分 析 
提供 了 依据 。 为 便于 分 析 ， 需 要 对 其 进行 动力 学 建 模 并 进行 简化 。 

双 足 步行 机 器 人 分 为 前 向 模型 和 侧 向 模型 。 前 向 模型 主要 用 来 分 析 行 走 前 行 时 的 步 态 特 
性 以 及 步行 时 的 平稳 特性 ， 而 侧 向 模型 则 更 多 地 体现 了 行走 时 侧 向 的 平稳 性 。 国 内 外 学 者 曾 
对 两 足 步 行 机 构 的 前 向 模型 和 侧 向 模型 进行 研究 和 假设 性 分 析 ， 如 马 宏 绪 等 人 在 一 定 假 设 的 
基础 上 认为 双 足 步行 机 构 的 侧 向 和 前 向 的 步行 运动 互 不 影响 ， 可 以 分 开 建 模 分 析 ， 以 便 得 到 
用 于 步 态 设 计 和 控制 规律 综合 的 双 足 步行 机 器 人 模型 。 正 是 借鉴 于 前 人 研究 的 建 模 法 ， 
对 双 足 步行 机 器 人 的 前 向 模型 和 侧 向 模型 分 开 建 模 。 

迄今 为 止 ， 对 双 足 步行 机 器 人 的 基本 研究 思路 可 以 分 为 基于 仿生 学 原理 和 基于 动态 控制 
原理 两 种 类 型 。 这 两 种 不 同 思路 的 研究 方法 在 双 足 步行 机 器 人 的 步 态 设 计 和 规划 中 都 有 广泛 
应 用 。 
2.3.5.2 ZMP 稳定 性 判 据 

双 足 步行 机 器 人 研究 的 一 个 关键 问题 是 实现 其 稳定 地 行走 。 目 前 世界 上 大 多 数 双 足 步行 
机 器 人 系统 都 采用 ZMP 作为 稳定 行走 的 判 据 。ZMP 即 零 力矩 点 ， 是 由 前 南斯拉夫 学 者 
Vukobratov (简称 伍 氏 ) 提出 的 关于 步行 稳定 性 的 经 典 理论 ， 他 研究 了 ZMP 与 双 足 动态 系统 
之 间 的 关系 ， 提 出 ZMP 是 判断 动态 平衡 的 一 个 重要 依据 。ZMP 是 这 样 描述 的 : ZMP 是 地 面 
上 的 一 点 ， 重 力 和 惯性 力 对 这 一 点 的 力矩 ， 其 水 平分 量 为 零 。 也 就 是 说 整个 系统 对 于 这 个 点 
的 前 向 、 侧 向 的 倾 翻 力矩 为 零 。 他 指出 ， 当 双 足 机 构 处 于 动态 平衡 时 ，ZMP 和 脚底 所 受 地 
面 反 力 的 压力 中 心 (Center of Pressure, CoP) 是 重合 的 。 因 此 我 们 可 以 根据 检测 到 的 地 面 反 
力 信 息 ， 计 算 CoP， 通 过 控制 策略 调整 ZMP 和 CoP 的 位 置 ， 使 二 者 重合 ， 实 现 机 器 人 的 动 
态 稳定 行走 。 

作用 在 机 器 人 脚底 的 实际 地 面 反 力 (包括 垂直 反 力 和 摩擦 力 ) 作用 点 如 能 与 期 望 ZMP 
重合 ， 并 落 在 支撑 面 上 ， 则 对 于 机 器 人 无 翻转 力矩 ， 从 而 使 机 器 人 处 于 稳定 行走 状态 。 

期 望 ZMP 计算 公式 
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[mix (2, eg) mzjx; * V,.] 


Xp = = n 
Yn +g) 
i-l 

by [ m,y; Cz; +g) 全 m;z;y; 十 V, ] 

了 zwp = c n (2-1) 
È mlz +g) 
i=l 
Ze 70 

式 中 x,y,z 部 分 质心 坐标 ; 


mi 一 一 机 器 人 身体 各 部 分 的 重量 ; 
Vys V,— RIIKI 
XOY 在 脚底 板 所 在 平面 ，Z 轴 垂 直 地 面向 上 。 
实际 ZMP 计算 主要 由 六 维 力 /力矩 传感器 进行 测量 获得 。 
机 器 人 脚底 的 实际 ZMP 点 和 期 望 ZMP 点 的 分 布 示意 如 图 2-2 所 示 。 
如 不 重合 ， 则 翻转 力矩 计算 式 为 实际 地 面 


j 反 力 
Ti = CXoynzup 7 X sz ) Zur (2-2) 
Tii = ( Y gzmp 一 Ymizup )Zur- xa (2-3) 
了 旋转 = (Xyrazme 一 实际 zMP ) 向 广 义 力 十 
CY gyenzup e 了 实际 zwp ) Xarxa (24) 
式 中 T uii ` T wig ` 了 旋转 作用 在 机 器 人 上 的 前 向 力 ) XJ 
AB. MDEE E; — A 一 实际 ZMP B 一 期 望 ZMP 
Xynzaps Youzu 一 期望 ZMP 点 的 坐标 ; 


图 2-2 ”机 器 人 脚底 的 实际 ZMP 

Xspizyp、Yzpizup ”一 一 实际 ZMP 点 的 坐标 。 点 和 期 望 ZMP 点 的 分 布 示 意图 

根据 ZMP 原理 得 到 的 结论 : 

1) 通过 改变 脚 的 姿态 ， 改 变 实际 ZMP 的 位 置 ; 

2) 通过 改变 惯性 力 的 大 小 (速度 和 姿态 ) ， 改 变 期 望 ZMP 的 位 置 。 

以 ZMP 作为 双 足 步行 机 器 人 动态 行走 的 稳定 判 据 ， 建 立 了 基于 六 维 力 /力矩 传感器 的 实 
bs ZMP 检测 系统 ， 使 双 足 步行 机 器 人 能 够 实现 ZMP 的 闭环 控制 。 

ZMP 本 是 针对 双 足 步行 提出 的 ， 但 一 些 研究 人 员 将 其 应 用 到 双 足 跑步 领域 。Kajita 将 机 
器 人 简化 为 一 个 无 质量 弹簧 腿 的 倒立 摆 ， 在 单 腿 文 撑 期 遵守 ZMP 准则 ， 在 腾空 期 根据 弹道 
模型 得 到 飞行 轨迹 。 国 内 有 人 将 跑步 稳定 性 分 为 支撑 阶段 和 腾空 阶段 ， 在 文 撑 阶 段 限制 机 器 
人 足 与 地 面 完全 接触 ， 仍 然 遵 守 ZMP 稳定 准则 。2003 年 ， 日 本 索尼 公司 发 布 了 其 跑步 机 器 
人 QRIO 的 实验 录像 。2004 年 底 ， 日 本 本 田 公 司 公 布 了 ASMO 的 跑步 实验 录像 。 基 于 商业 
机 密 的 考虑 ， 以 上 公司 没有 公布 其 技术 细节 ,但 从 录像 可 以 明显 看 出 ， 这 些 机 器 人 平 脚 板 落 
地 和 平 脚板 腾空 ， 仍 然 遵守 ZMP 平衡 准则 。 实 质 上 ，ZMP 的 基本 概念 和 判 据 是 通过 对 约束 
的 描述 ， 确 切 地 说 是 对 机 器 人 足 与 地 面 完全 接触 的 约束 ， 来 间接 反映 静态 和 准 动态 步行 的 平 
衔 性 ， 由 于 没有 从 步行 的 本 质 去 研究 稳定 性 ， 并 缩小 了 步行 运动 的 范围 ， 因 而 无 法 解释 双 足 
机 器 人 行走 时 的 动态 运动 。 由 于 长 期 沿用 ZMP 稳定 判 据 来 研究 双 足 步行 机 器 人 ， 各 种 相关 


39 


研究 一 直 没 有 从 根本 上 突破 其 基本 概念 、 定 义 及 其 理论 模型 ， 致 使 双 足 步行 的 基础 理论 严重 
清 后 于 拟人 机 器 人 样机 技术 的 发 展 ， 并 且 已 经 成 为 进一步 揭示 人 类 复杂 步行 运动 规律 ， 提 高 
样机 步行 性 能 ， 实 现 大 步 幅 快速 步行 、 动 态 跑步 和 跳跃 等 类 人 重要 运动 功能 的 瓶 希 问题 。 

综 上 所 述 ， 近 年 来 机 器 人 领域 的 研究 人 员 对 双 足 步行 机 融 人 的 稳定 性 与 控制 策略 进行 了 
大 量 的 研究 ， 取 得 了 一 系列 的 重要 进展 。 但 是 在 以 下 几 个 方面 还 需要 更 进一步 研究 : 

(1) 双 足 运动 的 动态 稳定 与 控制 机 理 ”稳定 性 是 仿 人 机 器 人 的 核心 问题 ， 目 前 基于 
ZMP 的 准 动态 理论 不 能 满足 双 足 机 器 人 今后 的 发 展 需要 ， 也 无 法 解释 自然 界 双 足 生 物 的 复 
杂 运 动 。 因 此 迫切 需要 一 套 具有 更 广 应 用 范围 的 、 适 合 双 足 机 带 人 的 动态 运动 的 稳定 性 理论 
体系 。 

(2) 双 足 步行 运动 的 回 有 和 鲁 棒 性 机 理 ” 双 足 步 行 的 鲁 棒 性 问题 是 仅 次 于 稳定 性 的 男 一 
个 重要 研究 领域 。 双 足 生物 对 路 面 环境 、 自 身 的 力学 参数 都 具有 很 强 的 鲁 棒 性 。 而 目前 的 双 
足 机 器 人 的 步行 运动 对 环境 和 自身 的 力学 参数 依赖 性 很 大 ， 因 此 给 出 这 种 鲁 棒 性 的 数学 意义 
上 的 内 药 解 释 和 严格 证 明 就 显得 十 分 重要 。 

(3) 实时 步 态 规划 与 控制 ”目前 双 足 机 顺 人 步 态 规划 的 研究 主要 集中 在 离线 的 产生 ， 
这 种 规划 模式 在 一 定 程 度 上 限制 了 步行 的 灵活 性 。 因 此 需要 采用 在 线 步 态 合成 方法 解决 双 足 
机 器 人 对 不 同 环境 的 适应 性 问题 。 计 算 机 技术 的 发 展 在 一 定 程 度 上 解决 了 计算 速度 的 瓶颈 问 
题 ， 因 而 实时 步 态 规划 与 基于 传 感 顺 的 大 闭环 反馈 控制 是 未 来 的 研究 方向 。 


2. 3.6 ”人 机 交互 的 实现 方法 


在 对 交互 过 程 中 的 多 模式 信息 采集 、 认 知 特征 提取 、 多 模式 行为 关联 融合 ， 及 人 拟 数 字 
化 分 析 方 法 与 应 用 技术 展开 深入 研究 的 过 程 中 ， 围 绕 交 互 过 程 的 多 模式 信息 认 知 特征 的 提 
取 、 人 拟 数字 化 技术 以 及 分 布 式 认 知 模型 的 建立 方法 ， 构 造 符合 人 类 感知 和 认 知 行为 的 典型 
应 用 背景 下 机 器 人 个 性 化 交互 平台 。 具 体 实现 方法 包括 以 下 6 个 方面 : 

(1) 用 户 基础 信息 的 特征 提取 方法 “该 方法 是 寻求 能 够 实时 、 准 确 地 反映 用 户 与 其 机 
器 人 交流 过 程 中 脸 部 表情 、 视 线 关 注 检 测 、 身 体 姿 态 、 声 音 及 语言 文字 、 肢 体 行为 、 步 态 信 
息 等 多 模 态 特征 的 、 可 计算 的 表示 方法 ， 基 于 多 模 态 信息 融合 技术 ， 为 人 拟 数 字 化 特征 表达 
及 认 知 特征 的 自动 获取 ， 提 供 高 效 的 基础 性 支持 。 

(2) 提取 信息 的 人 拟 数 字 化 特征 表达 方法 ”这 种 方法 是 研究 高 效 、 准 确 地 表达 交流 过 
程 中 的 人 性 化 感知 方法 ， 基 于 交互 过 程 中 的 脸 部 表情 、 身 体 姿态 、 语 音信 息 、 肢 体 行为 等 数 
据 ， 构 造 出 符合 人 类 认 知 心理 特征 的 智能 化 表达 ， 消 除 “ 交 互 壁垒 ”问题 。 

(3) 多 模 态 信息 融合 方法 ”该 技术 是 基于 图 像 、 语 音 、 文 本 、 触 觉 及 其 他 多 种 传感器 
所 提取 的 可 计算 信息 (已 完成 人 拟 数字 化 特征 表达 ) 的 一 种 融合 方法 ， 可 以 增强 基本 特征 
的 多 源 复合 效用 ， 提 高 机 器 人 认 知 特征 提取 及 交流 过 程 的 表达 能 力 。 

(4) 高 效 分 布 式 认 知 特征 的 自动 获取 及 其 模型 的 建立 方法 ”此 方法 研究 如 何 基于 人 脑 启 
发 式 的 感知 数字 化 特征 表述 ， 抽 取 能 够 恰当 反映 用 户 感 知 和 认 知 信息 的 认 知 特征 ， 以 及 如 何 
对 提取 的 认 知 特征 进行 有 效 评估 的 客观 评价 标准 ; 以 家 庭 背 景 下 的 机 器 人 为 具体 研究 对 象 ， 
研究 认 知 模型 的 建立 方法 ， 使 得 机 器 人 的 交流 模式 信息 符合 人 类 的 感知 与 认 知 行为 ， 产 生 的 
结果 更 加 贴近 用 户 的 交流 要 求 。 此 技术 最 终 目 的 就 是 利用 机 器 人 数据 处 理 方面 的 高 精度 、 高 
鲁 棒 、 高 速度 等 计算 特点 对 所 提取 的 、 大 量 的 多 模式 信息 进行 符合 用 户 行为 的 内 容 解析 ， 得 
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到 满足 用 户 要 求 的 表达 结果 ， 即 在 面向 用 户 的 机 器 人 上 建立 有 效 的 、 用 于 模拟 用 户 认 知 、 反 
映 用 户 交 流 过 程 中 个 性 偏好 的 可 计算 特征 。 分 布 式 认 知 模型 的 建立 与 引入 ， 可 以 实现 用 户 认 
知 的 可 计算 客观 特征 空间 与 其 主观 心理 空间 之 间 的 映射 。 

(5) 关联 融合 的 多 模式 行为 合成 方法 ”研究 如 何 基 于 所 获取 的 恰当 反映 用 户 感 知 和 认 知 
言 息 的 认 知 特征 以 及 分 布 式 认 知 模型 ， 研 究 符合 其 人 因 特 征 的 多 模 态 行为 模式 及 其 高 效 的 关 
联 融 合算 法 和 控制 系统 ， 使 所 产生 的 结果 与 交流 过 程 中 儿童 生理 和 心理 要 求 趋 于 一 致 。 同 时 
通过 关注 模型 等 手段 ， 对 于 玩 伴 机 器 人 关联 融合 的 多 模式 行为 合成 进行 客观 的 综合 评 佑 。 

(6) 个 性 化 实时 交互 方法 ”由 于 每 个 用 户 在 情绪 状态 、 人 性格 特点 、 兴 趣 喜 好 等 方面 的 个 
体 差异 很 大 ， 对 交流 过 程 中 的 需求 各 式 各 样 ， 因 此 这 种 技术 结合 了 用 户 的 认 知 特性 来 表达 实 
现 个 性 化 的 实时 交互 功能 。 利 用 此 项 技术 可 人 研制 出 融合 分 布 式 认 知 模型 的 、 可 进行 个 性 化 交 
互 的 机 器 人 ， 使 其 能 够 根据 用 户 的 偏好 需求 ， 将 基于 人 拟 数字 化 特征 表达 的 脸 部 表情 、 身 体 
姿态 、 语 音信 息 、 肢 体 行为 等 模式 自然 地 表现 出 来 ， 完 成 不 同 交 互 模式 的 平滑 切换 ， 产 生 符 
合 要 求 的 个 性 化 交互 结果 。 根 据 在 交互 过 程 中 视觉 、 语 音 及 其 他 多 传 感 硕 所 获取 的 脸 部 表 
情 、 身 体 姿 态 、 语 言 信息 、 肢 体 行为 等 信息 ， 分 析出 其 深层 次 的 情绪 状态 、 性 格 模式 等 个 性 
化 特征 ， 去 除 掉 用 户 厌烦 的 、 不 感 兴趣 的 感知 内 容 ， 提 取出 其 真正 关心 的 感知 内 容 ， 由 上 述 
所 建立 的 分 布 式 认 知 模型 以 及 个 性 化 情感 状态 空间 转移 的 非 线性 模型 ， 实 时 自动 合成 出 关联 
融合 的 多 模式 行为 ， 以 满足 用 户 与 机 带 人 之 间 个 性 化 的 上 自然、 和谐、 每 畅 的 实时 交流 。 


2.4 小 结 


本 章 主 要 介绍 了 双 足 机 器 人 的 相关 理论 与 技术 ， 双 足 步 行 机 器 人 研究 平台 集 多 学 科 于 一 
体 ， 可 涉及 位 置 与 姿态 的 稳定 性 控制 、 动 力学 建 模 、 行 为 动作 的 自动 生成 、 和 谐 人 机 交互 、 
人 工 智 能 、 人 工 心理 与 人 工 情感 等 多 个 方面 。 
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4535 双 足 步行 机 项 人 的 相关 技术 


通过 上 一 音 的 介绍 和 分 析 ， 我 们 不 难 发 现 制作 双 足 机 器 人 需要 多 种 技术 的 支撑 ， 其 中 主 
要 技术 包括 : 行为 数据 库 技术 、3D 建 模 及 虚拟 现实 技术 、 双 足 机 器 人 建 模 技术 、 多 智能 体 
通信 技术 及 多 智能 体 协 调控 制 技术 等 ， 下 面具 体 加 以 介绍 。 


3.1 动作 自动 生成 一 一 行为 数据 库 技 术 


我 们 所 介绍 的 系统 中 ， 有 一 个 重要 的 环节 就 是 组 建 机 器 人 行为 数据 库 ， 机 器 人 的 行为 和 
人 的 行为 一 样 可 以 分 为 很 多 细节 。 一 个 连续 的 行为 表达 ， 是 由 很 多 个 细小 的 行为 元 素 组 成 
的 。 下 面 以 向 前 步行 为 例 来 说 明 行为 数据 库 的 组 成 。 

机 器 人 的 行为 数据 库 是 由 细 分 的 行为 数据 单元 组 成 的 。 每 一 个 动作 图 片 对 应 唯一 的 动作 
数据 ， 这 样 的 动作 单元 的 不 断 积累 ， 也 就 构成 了 我 们 的 行为 数据 库 ， 即 行为 发 生 器 。 图 片 的 
直观 性 也 给 我 们 组 合 其 他 复杂 的 动作 带 来 了 便利 。 

根据 数据 生成 的 原理 可 以 保证 最 基本 的 动作 数据 的 稳定 性 和 可 靠 性 。 但 是 基本 数据 及 其 
连接 之 间 的 过 渡 过 程 是 否 稳定 、 可 靠 就 很 难保 证 。 为 了 解决 这 个 问题 ， 我 们 采用 了 两 种 办 
法 : 中 采用 静态 数学 模型 稳定 性 判 据 来 判断 ，@ 加 一 个 过 渡 过 程 ， 即 在 一 个 基本 动作 的 开头 
和 结尾 都 加 一 个 可 靠 的 过 渡 点 。 实 践 证 明 ， 方 法 @ 较 为 适合 。 

双 足 步行 机 器 人 具有 非 线 性 、 强 耦合 等 特性 ， 易 受 环境 干扰 ， 特 别 是 机 器 人 与 地 面 接触 
环境 的 不 确定 性 和 局 限 性 导致 双 足 机 器 人 行走 控制 难度 增 大 。 利 用 行为 发 生 器 ， 组 合 出 了 一 
组 机 器 人 上 台阶 的 动作 ， 并 保证 其 稳定 性 。 这 也 证 明了 本 章 所 介绍 的 基于 行为 发 生 絮 的 步 态 
控制 是 可 行 的 。 当 然 ， 该 方法 也 有 很 多 不 足 之 处 有 竺 改进 ， 例 如 ， 通 过 提供 大 量 的 传感器 反 
馈 信 息 来 提高 控制 精度 。 


3.2 3D 虚拟 仿真 技术 


仿真 是 利用 一 个 模型 来 模仿 实际 系统 所 发 生 的 运动 过 程 进行 试验 的 技术 ， 仿 真 技术 在 科 
学 研究 、 工 程 设 计 、 军 事 演 练 等 领域 中 ， 早 已 广泛 应 用 。 现 代 计 算 机 与 仿真 相 结 合 ， 形 成 了 
计算 机 仿真 技术 ， 为 仿真 赋予 新 的 内 涵 ， 并 开辟 了 更 加 广阔 的 应 用 空间 。 计 算 机 仿真 技术 作 
为 一 门 新 兴 的 高 技术 ， 在 减少 损失 、 节 约 经 费 、 缩 短 开发 周期 、 提 高 产品 质量 等 方面 发 挥 了 
巨大 作用 。 

传统 的 产品 开发 过 程 一 般 分 为 功能 设计 、 结 构 设 计 、 样 机 研制 与 试验 等 几 个 阶段 。 其 中 
样机 制造 与 试验 是 传统 产品 开发 过 程 中 不 可 缺少 的 环节 。 虽 然 样机 制造 和 试验 可 以 解决 许多 
在 设计 中 无 法 预料 的 问题 ， 但 也 带 来 了 一 个 负面 影响 ， 即 增加 产品 成 本 和 延长 了 设计 周期 。 
随 着 计算 机 科学 技术 的 发 展 和 广泛 运用 ， 虚 拟 样机 技术 的 出 现 解 决 了 这 个 问题 。 它 可 以 在 计 
算 机 上 方便 地 修改 设计 缺陷 ， 仿真 试验 相同 的 方案 ， 对 整个 系统 进行 不 断 改进 ， 直 至 获得 优 
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化 设计 方案 以 后 ， 再 出 物理 样机 。 

随 着 机 器 人 技术 的 迅速 发 展 ， 机 器 人 在 各 方面 也 得 到 了 广泛 的 应 用 。 然 而 由 于 机 絮 人 综 
合 了 机 、 电 、 液 的 复杂 动态 系统 ， 因 此 通过 计算 机 仿真 来 模拟 系统 的 动态 特性 ， 才 能 揭示 机 
构 的 合理 运动 方案 及 有 效 的 控制 算法 ， 从 而 解决 在 机 带 人 设计 、 制 造 以 及 运行 过 程 中 的 问 
题 。 机 器 人 仿真 技术 大 致 分 为 以 下 儿 类 . 

1) 对 制造 系统 中 机 器 人 的 应 用 开展 的 研究 ， 如 柔性 制造 系统 或 计算 机 集成 制造 系统 中 
机 器 人 的 仿真 问题 。 

2) 针对 机 器 人 本 身 的 特性 进行 仿真 研究 ， 如 运动 学 仿真 、 动 力学 仿真 、 轨 迹 规 划 和 碰 
撞 检 验 等 问题 。 

3) 机 融 人 离线 编程 系统 的 研究 ， 如 利用 仿真 生成 满意 的 运动 方案 白 动 转换 成 机 器 人 鬼 
制程 序 去 驱动 控制 其 动作 。 机 械 工程 中 的 虚拟 样机 技术 又 称 为 机 械 系统 动态 仿真 技术 ， 是 
20 世纪 80 年 代 随 着 计算 机 发 展 起 来 的 一 项 新 技术 ， 其 核心 是 机 械 系 统 运 动 学 和 动力 学 仿真 
技术 ， 同 时 还 包括 三 维 CAD 建 模 技 术 、 有 限 元 分 析 技术 、 机 电 液 控制 技术 、 最 优化 技术 等 
相关 技术 ， 见 图 3-1。 运 用 虚拟 样机 技术 ， 可 以 大 大 简化 机 械 产 品 的 设计 开发 过 程 ， 大 幅度 
缩短 产品 开发 周期 ， 大 量 减少 产品 开发 费用 和 成 本 ， 明 显 提高 产品 质量 ， 提 高 产品 的 系统 性 
能 ， 获 得 最 优化 和 创新 的 设计 产品 。 以 计算 机 辅助 设计 为 基础 ， 把 虚拟 搁 术 和 仿真 技术 相 结 
合 ， 为 产品 的 研发 提供 了 一 个 全 新 的 设计 方法 。 这 些 技术 构成 了 功能 完善 的 虚拟 样机 系统 的 
技术 体系 。 包 含 技术 简介 如 下 : 

(1) 三 维 建 模 的 计算 机 辅助 设计 技术 (CAD) ”用 于 机 械 系统 的 几何 建 模 ， 以 及 展现 机 
械 系统 的 仿真 分 析 结 果 。 

(2) 有 限 元 分 析 (FEA) 技术 可 以 利用 机 械 系 统 的 运动 学 和 动力 学 分 析 结 果 ， 输 出 
进行 机 械 系 统 有 限 元 分 析 所 需 的 载荷 和 边界 条 件 。 同 时 也 可 利用 有 限 元 分 析 对 构 4”f? | 应 
力 、 应 变 和 强度 的 结果 ， 进 行进 一 步 的 分 析 。 

(3) 模拟 各 种 作用 力 的 软件 编程 技术 虚拟 样机 软件 运用 开放 式 的 软件 编程 技术 进行 
模拟 , 例如; 液压 冲击 、 气 动力 、 风 力 、 轮 胎 振动 等 ， 以 满足 各 种 机 械 系 统 的 要 求 。 

(4) 利用 实验 装置 的 实验 结果 进行 构件 的 建 模 ”实验 结果 经 过 线性 化 处 理 输 入 机 械 系 
统 ， 成 为 机 械 系统 模型 的 一 个 组 成 部 分 。 


驱动 元 件 
建 模 


有 限 元 分 析 
(FEA) 技 术 


系统 最 优化 
技术 


图 3-1 虚拟 样机 系统 
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(5) 控制 系统 设计 与 分 析 技 术 ”虚拟 样机 软件 可 以 运用 经 典 和 现代 控制 理论 ， 进 行 机 
械 系统 的 运动 仿真 分 析 。 或 者 可 以 应 用 其 他 专用 的 控制 系统 分 析 软 件 ， 进 行 机 械 系统 和 控制 
系统 的 联合 分 析 。 

(6) 优化 设计 和 分 析 技 术 运用 虚拟 样机 分 析 技 术 进行 机 械 系统 的 优化 设计 和 分 析 ， 
通过 优化 分 析 ， 确 定 最 佳 设 计 结构 和 参数 值 ， 使 机 械 系统 获得 最 佳 的 综合 性 能 。 


3.3 ” 双 足 步行 机 器 人 建 模 的 方法 与 技术 


3.3.1 ADAMS 建 模 方法 


机 械 系 统 动力 学 自动 分 析 软 件 ADAMS (Automatic Dynamic Analysis of Mechanical Sys- 
tems), ÆRE MDI 公司 开发 的 非常 著名 的 虚拟 样机 分 析 软 件 。ADAMS 的 整个 计算 过 程 指 
从 数据 的 输入 到 结果 的 输出 ， 不 包括 前 、 后 处 理 功能 模块 。 可 以 分 成 以 下 几 个 部 分 : 中 数据 
的 输入 ;，@ 数 据 的 检查 ; @@ 机 构 的 装配 及 过 约束 的 消除 ; 由 运动 方程 的 自动 形成 ; ORME 
代 运 算 过 程 ; @ 运 算 过 程 中 的 错误 检查 和 信息 输出 ; 2 结果 的 输出 。 

拟人 机 器 人 建立 虚拟 样机 的 物理 模型 是 为 了 验证 拟人 机 器 人 模型 的 运动 性 能 ， 并 通过 模 
型 计算 出 各 个 关节 的 驱动 力矩 、ZMP 的 变化 轨迹 等 。 


3.3.2 ”模型 的 数据 转换 


在 建立 虚拟 样机 模型 过 程 中 ， 如 果 简 单 地 通过 Mechanism/Pro 将 已 经 设计 完成 的 Pro/E 
模型 数据 转换 到 ADAMS 中 ， 在 建立 ADAMS 模型 时 总 是 由 于 部 分 零件 的 缺失 、 装 配 关系 错 
误导 致 整个 模型 无 法 正确 显示 。 这 是 由 于 一 些 比较 复杂 的 零件 模型 转 入 ADAMS 后 特征 点 和 
读 取 的 路 径 缺 失 ， 从 而 造成 数据 传递 只 有 质量 、 惯 性 等 物理 信息 存在 ， 而 刚体 却 并 不 显示 所 
造成 的 。 

为 了 实现 拟人 机 器 人 模型 的 数据 转换 ， 在 对 模型 数据 转换 过 程 的 反复 观察 和 实践 后 发 
IE, Mechanism/Pro 传递 数据 的 实质 是 将 装配 体 的 各 零件 以 Stereolithography (. stl) 或 Ren- 
der (.slp) 格式 输出 的 同时 ， 产 生 两 个 记录 文件 transferToView. adm 和 aview. cmd, 

TransferToView. adm 是 ADAMS 数据 设置 文件 ， 它 记录 ADAMS 的 模型 数据 。 主 要 内 容 
为 : 装配 体 名 、ADAMS 地 面 信息 、ADAMS 零件 位 置信 息 ( 密度、 转动 惯量 、MARKER 数 
量 和 位 置 ) 、 单 位 制 等 。 

aview. cmd 是 ADAMS 的 命令 文件 ， 它 记录 ADAMS 的 操作 命令 。 主 要 内 容 规定 : AD- 
AMS 的 单位 制 (长 度 、 质 量 、 力 、 时 间 、 和 角度、 频率 ) ， 读 取 模 型 的 数据 类 型 、 路 径 、 名 
称 、 比 例 、 坐 标 、 隶 属 关系 ， 模 型 显示 状态 等 。 

这 两 个 文件 在 传递 过 程 中 对 零件 在 ADAMS 中 的 生成 和 定义 起 了 决定 性 的 作用 。 如 果 在 
传递 过 程 中 将 完整 的 零件 特征 、 装 配 信息 输入 这 两 个 文件 中 ， 就 可 以 实现 零件 和 模型 的 完整 
传递 ， 如 图 3-2 所 示 。 


机 械 系统 建 模 : 施加 运动 和 运动 约束 


了 分析: 设置 测量 和 仿 
仿真 分 析 


结果 分 析 : HER, 绘制 仿 
ZH 线 


验证 仿真 分 析 结 果 : 输入 实验 数据 ， 添 
加 实验 数据 曲线 


精制 机 械 系 统 模型 .增加 摩擦 力 ， 改 进 载荷 
函数 ， 定 义 柔 性 物体 和 连接 ， 定义 控制 


图 3-2 零件 和 模型 的 完整 传递 


3.4 ”多 智能 体 技术 


智能 体 通 过 传感器 感知 环境 ， 通 过 效应 
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分 析 : 设置 可 变 参 


机 械 系统 优化 分 析 : X 


: 题 设计 影响 


数 点 ， 定 义 设计 


研究 ， 进 行 实验 设计 研 


流程 图 


进行 最 优化 研究 


， 传 感 顺 相当 于 人 的 眼 、 耳 、 鼻 及 其 


E3 
与 环境 交互 ， 需要 对 信息 Ee Herb. 信息 融合 以 适当 方式 对 接收 到 的 信息 进 


LoT puo 腿 、 "i 身体 。 知 能 休 的 工作 过 程 如 图 3.3 所 示 。 智 能 体 不 仅 要 
行 处 理 。 信 息 Ma c 它 反映 了 智能 体 的 真正 功能 。 
感知 RS 
| 信息 交互 | 
l 信息 融合 | 
环境 | ! 智能 体 
| 信息 交互 | 
作 A e 


图 3-3 智能 体 的 工作 过 程 


实现 一 系列 预先 设 定 的 目标 或 任务 的 计算 机 系统 。 它 


具有 推 


智能 体 (Agent) 是 指 那些 宿主 于 复杂 的 动态 环境 ， 自 主 感知 环境 中 信息 ， 并 采取 行动 ， 


理 和 学 习 能 力 、 自 主 与 协同 工作 
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能 力 、 在 所 处 环境 中 的 灵活 访问 和 迁移 机 制 以 及 同 其 他 智能 体 (Agent) 的 通信 和 协调 机 制 ， 
概括 起 来 就 是 智能 性 、 代 理性 和 机 动 协调 性 。 该 技术 最 早出 现在 人 工 智能 领域 ， 其 最 大 特点 
是 具有 一 定 的 智能 及 良好 的 灵活 性 和 坚定 性 ， 特 别 适合 处 理 复 杂 、 难 以 预测 的 问题 。 基 于 智 
能 体 的 控制 模型 是 一 种 拟人 化 的 模型 ， 可 将 控制 系统 的 行为 和 其 他 扩展 单元 的 行为 统一 起 来 
构成 分 布 式 多 智能 体系 统 。 
多 智能 体系 统 (Multi-Agent System). 是 由 多 个 可 计算 的 智能 体 组 成 的 集合 ， 它 能 协调 一 
组 自主 体 的 行为 知识、 目标、 方法 和 规划 等 )， 协 同 完成 动作 "| 。 学 习 是 多 智能 体系 统 
的 重要 特征 之 一 ， 多 智能 体 学 习 可 以 看 做 是 多 智能 体系 统 和 机 器 学 习 等 研究 领域 的 结合 。 强 
化 学 习 是 一 种 以 环境 反馈 作为 输入 的 适应 环境 的 机 融 学 习 方 法 。 它 不 需要 对 环境 的 先 验 知 
识 ， 具 有 无 监督 的 自 适应 能 力 ， 因 而 被 认为 是 设计 智能 体 (Agen) 的 核心 技术 之 一 。 

多 智能 体系 统 是 针对 一 群 不 同 种 类 的 、 自 治 的 智能 体 的 群体 行为 所 进行 的 研究 ， 这 些 智 
能 体 可 能 为 同一 目标 共同 工作 ， 也 可 能 为 存在 潜在 冲突 的 各 自 不 同 的 目标 工作 ” 。 这 方面 
的 研究 主要 受 分 布 式 人 工 智能 理论 和 人 工 生命 系统 的 影响 ， 其 研究 的 中 心 问题 可 以 概述 为 一 
句 话 :“ 在 一 个 只 有 我 们 所 设计 的 智能 体 的 世界 中 ， 智 能 体 是 如 何 与 其 他 智能 体 进行 相互 作 
用 的 "。 在 具体 的 研究 工作 中 ， 多 个 智能 体 之 间 如 何 协调 运用 各 自 的 知识 、 目 标 、 技 能 和 计 
划 共 同 采取 行动 、 解 决 问题 ， 是 一 个 重要 的 研究 内 容 。 多 智能 体系 统 的 应 用 分 类 如 图 3-4 所 
示 。 从 图 中 可 以 看 到 ， 多 机 器 人 系统 的 研究 与 多 智能 体系 统 研究 是 密切 相关 的 。 多 机 器 人 系 
统 为 多 智能 体系 统 理论 应 用 于 实际 环境 中 提供 了 实验 平台 ， 同 时 多 智能 体系 统 理论 的 研究 为 
多 机 器 人 系统 和 多 机 器 人 协调 协作 提供 了 理论 基础 ” 。 

近年 来 ， 随 着 机 器 人 Agent 模型 在 多 机 器 人 协调 中 的 应 用 以 及 为 了 解决 多 机 器 人 合作 所 
存在 的 问题 ， 基 于 分 布 式 人 工 智能 中 多 智能 体系 统 (MAS) 理论 ( 见 图 3-4) 的 多 机 器 人 协 
作 已 成 为 机 器 人 学 研究 领域 的 热点 ， 受 到 各 国 专家 学 者 的 普遍 关注 。 依 据 MAS 的 特性 ， 组 
织 和 控制 多 个 机 器 人 ， 使 之 能 合作 完成 单个 机 器 人 无 法 完成 的 复杂 任务 ， 其 主要 考察 的 是 系 
统 的 智能 行为 ， 因 此 它 不 同 于 一 般 的 控制 系统 而 必须 具有 实时 智能 。 


aaa 


多 智能 体 仿真 求解 分 散 的 问题 
多 智能 体系 统 建立 人 造 世 界 


PERM 
群体 机 器 人 学 aii 


程序 设计 


图 3-4 多 智能 体系 统 应 用 分 类 


3.4.1 智能 体 通信 技术 


3.4.1.1 通信 方式 

智能 体 的 通信 方式 分 为 黑板 系统 和 消息 系统 两 种 类 型 。 在 黑板 通信 系统 中 ， 智 能 体 通 过 
黑板 交换 信息 、 数 据 和 知识 ， 在 黑板 系统 中 智能 体 间 不 发 生 直接 通信 ， 采 用 消息 通信 可 以 实 
现 灵活 复杂 的 协调 策略 。 
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与 黑板 系统 不 同 ， 两 个 智能 体 间 消息 是 直接 交换 ， 执 行 中 没有 缓冲 。 广 播 是 一 种 特例 ， 
消息 发 给 每 个 智能 体 或 智能 体 组 。 通 常 发 送 者 要 为 消息 指定 唯一 的 地 址 ， 只 有 该 地 址 的 智能 
体 才能 读 这 条 消息 。 为 了 实现 协作 ， 所 有 智能 体 必须 知道 语言 的 语义 。 
3.4.1.2 通信 语言 

目前 国际 上 最 著名 的 智能 体 通信 语言 是 美国 国防 部 高 级 研究 计划 署 (Advanced Research 
Project Agency, ARPA) 的 知识 共享 计划 (Knowledge Sharing Effort) 中 提出 的 两 个 相关 语 
A: 一 个 是 KQML (Knowledge Query and Manipulation Language) ， 男 一 个 是 KIF (Knowledge 
Interchange Format), HP KQML 是 一 种 最 通用 的 智能 体 通 信 语 言 。 根 据 KOML 规范 ， 设 计 
了 一 种 适用 于 MAPS (Manage Access Points). 环境 下 的 智能 体 通信 语言 (Software Agent Com- 
munication Language, SACL) 。 该 语言 的 适用 前 提 如 下 : 

1) 管 能 体 单方 向 通信 ; 

2) 消息 传送 可 以 有 延迟 ; 

3) 消息 接收 方 知道 发 送 方 ，; 

4) 消息 交互 有 序 、 可 靠 。 

SACL 语言 的 BNF 语法 定义 如 下 : 


HR = < 动作 > ( < 空白 > < 参数 一 值 对 >) 
< 动作 es = < 标志 符 > 

< 参数 一 值 对 > :: = < 参数 名 > < 空白 > < 参数 值 > 

< 参数 各 > = < 标志 符 > 

< 参数 值 > : : = ( < ASCI 字符 >) 

< 标志 符 > : : = < 字母 > (< 字母 > | < 数字 >) 

< 空 日 > :: = (< 空格 > | < 换行 符 > | < 制 表 符 > ) 


3.4.1.3 通信 模型 

智能 体 通 信 时 ， 智 能 体 必须 知道 其 他 智能 体 的 名 称 、 通 信 地 址 、 能 力 等 。 可 以 通过 两 种 
方法 实现 : 第 一 种 方法 让 所 有 智能 体 都 保存 其 他 所 有 智能 体 的 信息 ， 这 种 方法 浪费 存储 空间 
且 不 利于 智能 体位 置 的 动态 更 新 ; 第 二 种 方法 设置 一 个 专门 的 通信 服务 器 用 来 保存 所 有 智能 
体 的 通信 信息 ， 当 智能 体 地 址 改变 时 ， 由 该 智能 体 通 知 通信 服务 器 ， 通 信服 务 器 位 置 不 改 
变 ， 所 有 智能 体 只 需 保 存 通信 服务 器 地 址 '” 。 

3.4.1.4 通信 服务 器 

通信 服务 器 是 一 类 特殊 的 智能 体 ， 在 智能 体 的 协作 中 起 着 重要 的 作用 。 在 多 智能 体系 统 
中 ， 无 论 是 一 般 智 能 体 还 是 通信 服务 器 都 有 通信 部 分 ， 将 它 抽 取出 来 ， 称 为 通信 模块 ， 它 包 
含 以 下 部 分 : 

(1) 协议 接口 ”为 通信 模块 的 其 他 部 分 提供 一 种 通信 方式 ， 使 它们 不 需要 考虑 通信 协 
议 。 此 外 ， 当 通信 协议 改变 时 ， 只 需 修 改 本 部 分 ， 其 余部 分 可 以 直接 使 用 。 协 议 接 口 包 含 以 
下 内 容 : 

1) 服务 线程 : 常 驻 服务 线程 ， 不 停 监 听 端 口 地 址 ， 一旦 发 现 有 消息 来 ， 启动 一 个 消息 
线程 处 理 该 消息 ， 然 后 继续 监听 。 

2) 消息 线程 : 由 服务 线程 启动 ， 读 人 消息 ， 放 和 接收 缓冲 区 中 。 

3) 客户 线程 : 由 发 送 线程 启动 ， 将 消息 发 出 。 
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4) 计时 器 : 超时 判断 。 收 发 消息 超时 情况 下 ， 结 束 相应 的 消息 线程 或 客户 线程 。 

(2) 接收 缓冲 区 ”缓存 外 界 发 来 的 消息 。 

(3) 发 送 缓冲 区 缓存 发 送 消息 。 

(4) 发 送 线程 ” 常 驻 线程 。 不 断 监视 发 送 缓冲 区 ， 发 送 缓冲 区 中 一 旦 有 消息 就 启动 协 
议 接口 中 的 方法 发 送 消息 。 

(5) 接收 线程 ”和 常 驻 线 程 。 不 断 监视 接收 缓冲 区 ， 一旦 有 消息 、 则 进行 解释 和 处 理 。 

(6) 解释 器 ”解释 并 处 理 通 信 原 语 。 

(7) 地 址 籍 ” 智 能 体 的 地 址 信 ， 一 般 智能 体 保留 交互 频繁 的 智能 体 地 址 ; 通信 服务 器 
保留 已 登记 的 所 有 智能 体 的 地 址 。 

(8) 消息 发 送 函 数 ”首先 在 地 址 敌 中 查询 目标 智能 体 的 地 址 。 如 果 没 有 则 向 通信 和 服务 
器 查询 。 得 到 目标 智能 体 地 址 后 ， 将 消息 放 入 发 送 缓冲 区 中 。 
3.4.1.5 通信 服务 
通信 服务 器 提供 的 服务 有 : 名 字 服 务 、 查 询 服务 、 订 购 服 务 、 智 能 体 生 存 期 服务 。 

(1) 名 字 服 务 智能 体 将 要 访问 的 智能 体 的 名 字 交 给 通信 和 服务器， 通信 服务 器 查询 智 
能 体 列 表 ， 返 回 被 查询 智能 体 的 地 址 。 在 多 通信 服务 器 模型 中 ， 如 果 一 个 通信 服务 器 不 知道 
某 个 智能 体 的 地 址 ， 它 会 询问 其 他 通信 服务 器 。 

(2) 查询 服务 ”智能 体 往往 需要 其 他 智能 体 提供 某 种 服务 。 这 时 智能 体 询问 通信 服务 
器 ， 通 信服 务 器 搜索 智能 体 及 其 服务 列表 ， 找 到 满足 条 件 的 智能 体 后 ， 返 回 智能 体 的 名 字 和 
地 址 。 

(3) 订购 服务 如 果 系 统 中 没有 智能 体 需 要 的 服务 ， 通 信服 务 器 返回 查询 失败 的 信息 ， 
智能 体 可 以 向 通信 服务 器 申请 订购 服务 。 当 有 新 的 智能 体 登记 系统 后 ， 通 信服 务 器 查询 新 增 
服务 ， 当 订购 服务 与 新 增 服务 相 匹 配 时 ， 通报 申 请 订购 服务 的 智能 体 。 

(4) 智能 体 生 存 期 服务 ”控制 智能 体 的 生成 和 终止 。 


3.4.2 多 智能 体 机 器 人 系统 的 数据 通信 与 协调 控制 


多 智能 体系 统 的 重要 特征 是 智能 体 间 的 协调 与 协作 。 协 调 是 指 一 组 智能 体 完 成 一 些 
集体 活动 时 相互 作用 的 性 质 ， 是 对 环境 的 适应 。 在 这 个 环境 中 存在 多 个 智能 体 并 且 都 在 执行 
某 个 动作 。 协 调 一 般 是 改变 智能 体 的 意图 ， 协 调 的 原因 是 由 于 其 他 智能 体 意图 存在 "。 协 
作 是 非 对抗 的 智能 体 之 间 保 持 行为 协调 的 一 个 特例 。 当 单个 智能 体 无 法 独立 完成 目标 时 ， 需 
要 其 他 智能 体 的 帮助 ， 这 时 就 需要 协作 。 协 作 通 常 建立 在 协调 的 基础 上 ， 在 复杂 的 环境 下 ， 
完成 不 同 目标 的 智能 体 必须 对 其 目标 、 资 源 进行 协调 。 

协调 与 协作 的 实现 都 离 不 开通 信 '" 。 本 节 研 究 和 实现 了 机 器 人 通信 系统 的 物理 传输 的 
底层 问题 ， 并 讨论 采用 多 智能 体 技 术 设 计 和 实现 多 个 类 人 机 器 人 信息 调度 与 通信 系统 的 软 
件 ， 提 供 良 好 的 通信 平台 以 实现 总 体 控制 功能 。 

在 多 机 器 人 环境 下 ， 机 器 人 间 的 协作 包括 两 部 分 : 机 器 人 的 任务 分 配 和 机 器 人 内 部 的 子 
目标 规划 。 任 务 分 配 将 全 局 目标 分 解 并 分 配给 系统 内 的 一 组 机 器 人 来 执行 。 为 了 实现 机 器 人 
间 以 及 机 器 人 内 部 功能 Agent 的 实时 协作 ， 需 要 构建 与 控制 体系 结构 相 适应 的 协调 控制 模型 
见 图 3-5， 并 采用 合适 的 实时 任务 调度 算法 "i。 本 节 介 绍 协作 的 底层 任务 分 配 和 调度 ， 不 涉 
及 高 层 的 协作 策略 。 
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规划 信息 


总 控制 Agent 


图 3-5 多 机 器 人 系统 的 通信 系统 网 络 结构 模型 


多 智能 体系 统 的 重要 特征 是 智能 体 间 的 协调 与 协作 。 协 调 是 指 一 组 智能 体 完 成 一 些 集体 
活动 时 相互 作用 的 性 质 ， 是 对 环境 的 适应 。 在 这 个 环境 中 存在 多 个 智能 体 并 且 都 在 执行 某 个 
动作 。 协 调 一 般 是 改变 智能 体 的 意图 ， 协 调 的 原因 是 由 于 其 他 智能 体 意图 存在 。 协 作 是 非 对 
抗 的 智能 体 之 间 保 持 行为 协调 的 一 个 特例 。 当 单个 智能 体 无 法 独立 完成 目标 时 ， 需 要 其 他 智 
能 体 的 帮助 ， 这 时 就 需要 协作 。 协 作 通 常 建立 在 协调 的 基础 上 ， 在 复杂 的 环境 下 ， 完 成 不 同 
目标 的 智能 体 必须 对 其 目标 、 资 源 进行 协调 。 

多 智能 体 技 术 实 现 多 个 类 人 机 器 人 信息 调度 与 通信 ， 提 供 良 好 的 通信 平台 以 实现 总 体 控 
制 功 能 。 


3.5 小 结 


本 章 讲述 了 双 足 机 器 人 技术 是 多 种 科学 技术 的 集合 体 ， 双 足 机 器 人 技术 的 发 展 是 离 不 开 
这 些 支撑 技术 的 ， 与 行为 数据 库 技术 、 虚 拟 现实 技术 、 建 模 技术 、 多 智能 体 通信 技术 密 不 可 
分 。 
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45435 双 足 步行 机 带 人 实验 平台 


步行 是 大 多 数 动物 所 具有 的 移动 方式 ， 也 是 生物 界 步 行 方式 中 自动 化 程度 最 高 、 最 为 复 
杂 的 动作 ， 它 的 完美 实现 必然 要 求 机 器 人 在 结构 设计 方面 产生 巨大 的 变革 和 创新 ， 从 而 有 力 
地 推动 相关 学 科 的 发 展 。 人 类 一 直 梦 想 着 创造 出 与 其 构造 相似 、 能 和 人 类 合作 的 拟人 型 机 器 
人 。 而 双 足 步行 机 器 人 是 工程 上 少 有 的 高 阶 、 非 线性 、 非 完整 约束 、 强 耦合 性 的 多 自由 度 系 
统 ， 这 为 机 器 人 运动 学 、 动 力学 以 及 控制 理论 的 研究 提供 了 一 个 理想 的 实验 平台 。 

机 器 人 步行 的 形式 主要 有 双 足 步行 、 四 足 步 行 和 六 足 步 行 " 1。 其 中 双 足 步行 是 步行 方 
式 中 自动 化 程度 最 高 、 最 为 复杂 的 系统 ， 同 时 双 足 步行 机 器 人 也 有 着 其 他 机 器 人 不 可 比拟 的 
优点 : 具有 适应 各 种 地 面 和 较 强 的 逾越 障碍 的 能 力 : 步行 机 器 人 的 功 耗 较 小 ， 通 常 低 于 轮 式 
和 履带 式 机 如 人 。 随 着 对 双 足 步行 机 带 人 研究 的 不 断 深入 ， 无 论 是 影视 、 科 幻 作 品 还 是 人 们 
对 机 器 人 的 第 一 意识 ， 都 把 像 人 一 样 的 机 器 人 作为 机 器 人 研究 的 最 高 境界 。 机 器 人 的 研究 者 
也 一 直 把 实现 机 器 人 的 拟人 行为 作为 梦 导 以 求 的 目标 。 拟 人 机 器 人 是 一 种 智能 的 、 机 劲 的 、 
能 满足 用 户 多 种 需求 的 新 型 机 器 人 ， 这 种 机 器 人 具有 人 的 外 形 和 基本 功能 ， 易 与 人 共处 ， 适 
应 多 变 的 活动 环境 。20 世纪 90 年 代 前 后 ， 双 足 步行 机 器 人 从 一 般 性 的 拟人 腿 部 行走 上 升 到 
全 方位 的 拟人 机 器 人 研究 。 拟 人 机 器 人 除了 腿 部 的 行走 功能 外 ， 还 包括 手 、 腰 和 头 的 功能 ， 
自由 度 比 双 足 步 行 机 器 人 成 倍 地 增加 ， 与 此 同时 也 带 来 了 控制 规划 、 动 力学 、 运 动 学 上 更 为 
复杂 的 问题 。 此 外 ,还 有 CCD 图 像 处 理 、 语 音 处 理 以 及 一 系列 传 感 信号 的 处 理 。 拟 人 机 器 
人 相对 于 双 足 步行 机 器 人 的 研究 ， 更 为 类 似 人 类 。 拟 人 机 融 人 是 由 仿生 学 、 机 械 工程 学 和 控 
制 工程 学 等 多 学 科 相 互 融合 而 成 的 综合 性 学 科 '* 。 

双 足 步行 机 器 人 的 发 展 也 为 人 类 假肢 的 发 展 提供 了 有 力 的 理论 和 技术 支持 ， 同 时 也 为 服 
务 、 娱 乐 机 器 人 的 发 展开 辟 了 新 的 领域 ”” 。 随 着 机 器 人 的 工作 环境 和 工作 任务 的 复杂 化 ， 
双 足 步行 机 器 人 因 其 体积 相对 较 小 ， 对 非 结构 性 环境 具有 适应 性 较 好 、 避 障 能 力 强 、 功 耗 
低 、 移 动 育 区 很 小 等 优良 的 移动 品质 格外 引 人 注 目 。 拟 人 机 顺 人 不 仅 具 有 双 腿 、 双 臂 、 头 、 
眼 、 颈 、 腰 等 物理 特征 ， 还 能 模仿 人 类 的 视觉 、 触 觉 、 语 言 ， 甚 至 情感 等 功能 。 这 和 能 
在 特种 环境 下 工作 的 服务 机 器 人 是 有 区 别 的 。 图 4-1b 为 北京 科技 大 学 所 研制 开发 的 双 足 步 
行 机 器 人 实验 平台 ， 该 平台 由 双 足 步行 机 器 人 、PIC 单片机 调试 器 、 传 感 器 实验 板 、 无 线 / 
有 线 发 射 模块 等 儿 部 分 组 成 。 通 过 前 面 章节 的 介绍 和 分 析 ， 我 们 已 经 掌握 了 双 足 机 器 人 的 基 
本 理论 、 方 法 和 相关 的 支撑 技术 ， 下 面 就 根据 这 些 知 识 点 ， 结 合 本 书 所 设计 的 实验 平台 ， 进 
行 有 针对 性 的 实际 环节 的 学 习 。 
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图 4-1 双 足 步行 机 器 人 平台 
a) 双 足 步行 机 器 人 外 形 b) 双 足 步行 机 器 人 实验 平台 


4.1 双 足 步行 机 器 人 控制 系统 


小 型 双 足 步行 机 器 人 由 于 体积 和 电源 (电池 ) 的 供电 能 力 有 限 ， 因 此 对 电路 的 结构 、 
元 器 件 的 布线 和 布局 都 有 较 高 的 要 求 。 对 于 这 种 要 求 ， 本 书 给 出 了 模块 化 的 系统 构成 ， 各 个 
功能 模块 之 间 相 对 独立 。 同 时 ， 模 块 间 通 过 接口 的 衔接 来 组 成 完整 的 系统 。 控 制 系统 的 总 体 
框图 如 图 4-2 所 示 。 

控制 系统 采用 多 级 分 布控 制 方法 ， 分 为 上 、 下 两 层 控制 ， 其 功能 分 别 为 ; 

(1) EE PC， 完 成 机 器 人 行为 数据 的 离线 计算 和 调整 ， 通 过 有 线 或 者 无 线 网 络 控制 
和 协调 各 个 机 器 人 的 动作 行为 ， 并 且 可 以 通过 机 器 人 所 带 的 传感器 获取 环境 信息 。 

(2) FE ”实现 控制 算法 ， 控 制 多 路 舵 机 协调 运动 ， 其 控制 系统 可 以 分 为 以 下 几 个 模 
He 

1) 电源 模块 : 向 下 位 机 系统 各 模块 提供 稳定 的 电压 。 

2) 数据 存储 模块 : dp PC 总 线 的 串 行 EPROM (24C512) 组 成 ，PIC16F877 Ñt P.C 
总 线 对 其 进行 读 写 操作 。 

3) 有 线 通信 模块 : 由 SP3232 电 平 转换 芯片 实现 ， 通 过 RS232 串 行 总 线 实 现 上 、 下 位 
机 的 数据 交互 。 

4) 无 线 通 信 模 块 : 由 nRF905 射频 芯片 和 STC2051 微 控 制 器 组 成 ， 通 过 射频 (RF) X 
现 上 、 下 位 机 的 数据 交互 。 

5) 电动 机 驱动 模块 ， 由 PIC16F877 主 微 控 制 器 组 成 ， 实 现 控 制 算法 、 下 位 机 协调 和 控 
制 多 路 舵 机 控制 信号 的 生成 。 
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图 4-2 ”控制 系统 的 总 体 结构 框图 


4.2 双 足 步行 机 恬 人 的 上 位 机 软件 


4.2.1 初始 化 设 定 模块 


在 机 器 人 的 安装 过 程 中 ， 由 于 关节 的 可 移动 性 ， 使 得 组 装 后 的 机 器 人 都 有 着 各 自 不 同 的 
初始 状态 。 在 这 种 情况 下 ， 如 果 我 们 仍然 采用 同一 参数 对 机 器 人 进行 初始 化 ， 则 最 终 会 发 
现 ， 所 有 的 机 器 人 姿势 各 不 相同 ， 而 原因 就 在 于 组 装 时 的 关节 误差 。 因 此 我 们 提出 了 初始 位 
置 (Homeposition) 的 概念 。 

初始 位 置 是 机 器 人 良好 直立 、 腿 部 各 舵 机 受 力 均匀 时 动作 的 名 称 。 我 们 所 调试 完成 的 每 
一 个 动作 数据 (如 上 所 述 ) 的 开始 和 最 后 的 动作 都 是 使 用 的 这 个 动作 。 初 始 位 置 是 在 每 个 
机 咒 人 安装 完毕 后 ， 首 先 调试 出 的 。 通 过 对 不 同 机 需 人 的 初始 位 置 进行 比较 ， 我 们 不 难 发 现 
它们 基本 上 都 有 所 不 同 ， 尽 管 这 其 中 应 考虑 调解 设 定时 的 人 为 因素 ,但 同时 也 说 明 每 台 舵 机 
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实现 相同 的 角度 都 是 不 尽 相同 的 ， 如 图 4-3 所 示 为 标准 90%。 和 显示 90° 实 际 带 偏差 舵 机 。 

对 机 器 人 的 操作 中 ， 初 始 化 的 设 定 有 着 非常 重要 的 意义 。 对 于 我 们 来 讲 ， 不 可 能 针对 每 
一 台 机 器 人 都 重复 同样 的 工作 去 调试 数据 ， 
这 样 做 不 但 浪费 时 间 ， 而 且 未 能 在 根本 上 解 
决 问题 的 所 在 。 

因此 ， 如 果 不 作 任何 处 理 ， 机 器 人 动作 
数据 的 可 移植 性 非常 差 ， 即 编号 为 Z1 的 机 器 
人 某 组 已 经 调试 成 功 的 动作 ， 直 接应 用 在 编 
号 为 Z2 的 机 器 人 上 效果 可 能 非常 不 好 ， 基 本 
上 需要 重新 做 大 量 的 调 斌 工作。 另外， 如果 
某 台 机 器 人 身上 的 某 一 舵 机 损坏 更 换 ， 则 其 
原来 的 某 些 动作 数据 也 会 因为 能 机 的 更 换 而 ”图 43 标准 90" 和 显示 为 90" 实 际 带 偏差 能 机 
变 得 不 能 使 用 。 

为 此 ， 我 们 仍 应 用 初始 位 置 来 解决 。 尽 管 由 于 工艺 问题 ， 每 台 舵 机 对 于 同一 角度 的 位 置 
并 不 相同 ， 但 是 我 们 可 以 人 为 地 进行 校正 ， 即 把 初始 位 置 作为 一 个 参考 基准 ， 而 今后 的 所 有 
动作 只 需要 在 此 舵 机 角度 上 进行 相应 的 释 加 就 可 以 完成 ， 我 们 把 与 其 进行 又 加 的 动作 数据 称 
为 给 定 控制 角 ， 也 称 相对 数据 ， 而 下 位 机 实际 收 到 的 数据 是 到 加 后 的 结果 ， 即 实际 控制 角 ， 
也 称 绝对 数据 。 三 者 之 间 关 系 如 下 式 所 示 。 

实际 位 置 角度 (°*) = 相对 转动 角度 (°) + 初始 位 置 (Homeposition ) 角度 (°) 


(4-1) 

这 样 ， 我 们 无 须 因为 舵 机 工艺 的 原因 对 于 每 台 机 融 人 的 动作 数据 进行 调试 ， 而 只 需要 调 

试 出 一 台 机 器 人 的 实际 控制 角 动 作 数 据 ， 根 据 式 (4-1 ) 求 出 相对 动作 数据 ， 即 给 定 控制 角 ， 

进而 保存 ， 就 可 以 反 向 运用 式 (4-1 ) 得 到 新 的 机 器 人 动作 实际 控制 角 数 据 ， 只 是 需要 注意 ， 

对 于 不 同 的 机 器 人 ， 使 用 公式 时 ， 初 始 位 置 项 均 应 为 对 应 机 器 人 的 实际 值 。 关 于 设 定 初始 位 
置 的 操作 如 图 44 所 示 。 


时 E Ho 
q “保存 初始 位 置 数据 | "TI zm 
A 读 职 初始 位 置 数据 > > ü 1 aii 修改 
"o 设 定 机 器 人 的 初始 位 置 | | 


44 初始 化 设 定 界 面 


因此 我 们 需要 设 定 这 样 一 个 初始 数据 ， 使 得 机 器 人 的 相对 初始 位 置 都 是 完全 一 样 的 。 那 
么 ,同样 一 组 数据 ， 对 于 所 有 的 机 器 人 都 可 以 使 用 ， 并 做 出 同样 的 动作 。 这 样 不 仅 可 以 免 去 
对 每 一 台 机 器 人 都 重复 做 同样 的 调试 数据 工作 ， 市 约 了 时 间 。 男 一 方面 ， 只 要 我 们 在 初始 位 
置 的 调试 上 对 每 台 机 器 人 都 进行 严格 的 规范 ， 就 可 以 同时 保存 多 台 机 器 人 的 初始 位 置 ， 而 只 
保存 一 套 动作 数据 ， 通 过 动作 数据 与 初始 位 置 的 简单 计算 ， 为 多 个 机 器 人 提供 统一 的 动作 数 
据 ， 使 机 器 人 的 动作 数据 具有 通用 性 ， 从 而 达到 动作 标准 统一 。 这 是 我 们 进行 多 机 器 人 表演 
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时 动作 质量 的 保证 。 初 始 位 置 、 相 对 动作 、 机 器 人 动作 数据 以 及 与 音乐 、 节 拍 、 和 情绪 状态 的 


关系 如 图 4-5 所 示 。 EIN ES 
4.2.2 ”机 器 人 的 运行 模式 与 通信 协议 

在 通信 中 ， 需 要 上 位 机 和 下 位 机 进行 
数据 通信 ， 而 异步 串 行 通信 是 一 种 常用 的 
通信 手段 。 通 信 协 议 也 叫 通 信 规 程 ， 是 指 
通信 双方 格式 上 的 约定 。 数 据 通信 中 ,在 
收 / 发 信 融 之 间 传送 的 是 一 组 二 进 制 位 串 ， 


但 它们 在 不 同 的 位 置 可 能 有 不 同 的 含义 ， 


有 的 只 是 用 于 同步 ， 有 的 代表 通信 双方 的 “站 | 
地 址 ， 有 的 是 一 些 控制 信息 ， 有 的 则 是 通 — Aq 


信 中 真正 要 传输 的 数据 ， 还 有 的 是 为 了 差 
错 控制 而 附加 上 去 的 宛 余 位 。 这 些 都 需要 图 45 初始 位 置 与 机 器 人 相对 动作 数据 的 关系 

在 通信 协议 中 事先 约定 好 ， 以 形成 一 种 收 /发 双方 共同 遵守 的 格式 。 在 逐 位 传送 的 串 行 通信 
中 ， 接 收 端 必须 能 识别 每 个 二 进 制 位 从 什么 时 候 开始 ， 这 就 是 位 定时 。 通 信 中 一 般 以 若干 位 
表示 一 个 字符 ， 除 了 位 定时 外 ， 还 需要 在 接收 端 能 识别 每 个 字符 从 哪里 开始 ， 这 就 是 字符 定 
时 。 

异步 品行 通信 时 ， 每 个 字符 作为 一 个 独立 的 信息 ， 可 以 随机 出 现在 数据 流 中 ， 即 每 个 字 
符 出 现在 数据 流 中 相对 时 间 是 任意 的 。 然 而 ， 一 个 字符 一 旦 开始 出 现 ， 字 符 中 各 位 便 以 预先 
固定 的 时 钟 进行 传送 。 因 此 异步 通信 方式 的 “异步 ”主要 体现 在 字符 与 字符 之 间 ， 而 同一 
字符 内 部 的 位 与 位 间 是 同步 的 。 为 确保 异步 通信 的 正确 性 ， 必 须 找到 一 种 方法 ， 使 收发 方 在 
随机 传送 的 字符 内 部 实现 同步 。 这 种 方法 就 是 在 字符 格式 中 设置 起 始 位 和 停止 位 ， 即 在 一 个 
字符 正式 发 送 之 前 先 发 一 个 起 始 位 ， 该 字符 结束 时 再 发 一 个 停止 位 。 接 收 器 检测 到 起 始 位 便 
知道 字符 到 达 并 开始 接收 字符 ， 检 测 到 停止 位 则 知道 字符 传输 已 结束 。 由 于 这 种 通信 协议 是 
徘 起 始 位 和 停止 位 来 实现 字符 内 部 同步 的 ， 所 以 有 时 也 称 为 起 止 式 协议 。 

下 位 机 与 上 位 机 PC 之 间 的 通信 ， 首 先 规定 好 彼此 之 间 的 通信 协议 ， 才 可 以 实现 上 位 机 
软件 与 下 位 机 软件 的 握手 。 软 件 握 手 最 大 的 弊端 是 传输 速度 慢 ， 因 为 每 发 送 一 帧 或 一 个 字 节 
的 数据 都 必须 实现 一 次 握手 过 程 ， 这 就 影响 到 了 传输 的 速度 。 选 择 软件 握手 是 基于 : 软件 握 
手 接收 数据 的 灵活 性 提高 了 。 采 用 软件 握手 ， 其 协议 完全 是 由 软件 给 出 ， 因 此 可 以 灵活 地 加 
以 改变 ， 以 适应 不 同 的 场合 。 

在 进行 数据 通信 的 软件 设计 时 必须 解决 好 两 个 方面 的 问题 : 一 是 可 靠 性 ， 二 是 速度 ， 而 
可 靠 性 是 主要 的 。 速 度 只 能 是 在 可 靠 的 基础 上 实现 。 可 靠 快 速 传 输 的 实现 需要 上 下 位 机 软件 
以 及 通信 协议 等 各 个 环节 及 其 间 相互 配合 。 完 成 便 件 层 的 串 行 通信 设计 较为 简单 ， 然 而 在 实 
际 中 ， 干 扰 是 不 可 避免 的 ， 因 而 仅仅 依靠 硬件 层 的 通信 必然 会 出 现 问题 。 为 了 实现 可 靠 通 
信 ， 就 必须 应 用 较为 可 靠 的 基于 帧 的 通信 协议 进行 各 种 数据 的 传输 。 

对 于 串 行 通信 而 言 ， 程 序 的 可 靠 性 是 由 协议 保证 的 。 通 信 的 可 靠 性 主要 体现 在 所 使 用 的 
通信 协议 上 ， 主 要 有 以 下 几 个 方面 : 

(1) 通信 之 前 先 握手 ”通过 握手 的 方式 可 以 判断 硬件 是 否 正 常 ， 计 算 机 是 否 处 于 等 待 


56 


状态 。 每 次 握手 之 间 等 待 一 段 时 间 ， 以 确保 计算 机 状态 

(2) 数据 传输 使 用 帧 的 方式 ”这 样 整 帧 数据 不 可 外 ERREK, 校 验 字 将 整 帧 信号 进行 
校 验 ,使 误 收 的 可 能 性 很 小 。 

(3) 帧 方式 通过 判断 帧 头 起 始 字 符 来 决定 一 帧 的 开始 ”这样 就 避免 了 部 分 数据 进入 到 
内 部 数据 处 理 之 中 ,这 使 数据 处 理 错误 的 可 能 性 减少 ， 并 可 防止 其 他 串 行 数据 和 要 求 数 据 混 
Ho 


(4) 丢 包 一 次 也 不 影响 程序 运行 B 机 器 人 启动 
使 在 强 干扰 环境 下 ， 对 于 单片机 接收 而 
言 ， 也 只 是 数据 传输 错误 。 pee. 


在 机 器 人 的 舞蹈 动作 表演 中 ， 上 位 机 
要 向 机 器 人 发 送 很 多 指令 和 人 参数， 如 : 机 
器 人 的 运行 模式 、 动 作 参 数 、 处 理 出 错 重 | ss 
传 和 多 个 机 器 人 之 间 的 动作 配合 等 。 同 样 


接收 指令 和 二 一 一 一 
的 ， 机 器 人 也 有 很 多 重要 反馈 参数 ， 如 机 数据 正确 ? 
器 人 初始 位 置 、 完 成 动作 、 动 作 数 据 / 指 — 
令 发 送 错误 等 信息 。 制 定 合理 的 通信 协 
议 ， 使 机 器 人 的 表演 更 具 灵 活性 和 交互 
性 ， 以 达到 机 器 人 表演 的 流畅 ， 并 且 使 机 
器 人 之 间 协 调配 合 。 机 器 人 端的 工作 流程 
如 图 4-6 所 示 。 守成 
通信 协议 可 分 为 两 种 模式 : En y — > 
(1) MARR 在 此 模式 下 ， 控 制 端 < 一 一 一 
实时 地 向 机 器 人 发 送 数据 ， 机 器 人 可 以 实 am 
时 地 根据 指令 进行 表演 ， 具 有 很 好 的 灵活 ma 
性 和 交互 性 。 但 是 由 于 控制 端 与 机 器 人 的 NERO 
RE XH 人 


能 够 全 面 地 掌握 机 器 人 的 状态 ， 所 以 动作 的 安全 和 质量 就 不 容易 得 到 很 好 的 保证 。 

(2) 发 送 模式 ”在 此 模式 下 ， 控 制 端 提前 向 机 器 人 发 送 数据 存储 在 机 器 人 的 存储 器 中 。 
执行 动作 时 ， 机 絮 人 按照 预先 设 定好 的 指令 进行 表演 ， 具 有 很 好 的 可 靠 性 ， 并 且 保 证 机 器 人 
的 动作 质量 。 但 是 由 于 控制 端 与 机 器 人 没有 很 好 的 实时 通信 过 程 ， 所 以 灵活 性 和 交互 性 就 不 
能 得 到 很 好 的 保证 。 

控制 端的 工作 流程 如 图 4-7 所 示 。 


4.2.3 双 足 步行 机 器 人 控制 端 软件 


上 位 机 的 控制 端 软 件 是 双 足 步行 机 咒 人 平台 的 重要 组 成 部 分 ， 在 整个 系统 中 ， 为 能 入 式 
系统 发 挥 着 后 台 支 撑 作 用 。PC 的 功能 很 强大 ,不管 是 硬件 资源 还 是 软件 资源 ,投入 式 系统 
都 无 法 和 PC 相 比 。 有 了 这 一 强大 的 后 盾 ， 我 们 对 机 带 人 的 操作 将 变 得 更 加 形象 、 便 捷 和 丰 
寅 多 彩 。 上 位 机 软件 由 主 界面 、 动 作 调试 模块 、 基 于 音乐 情绪 的 列表 界面 及 情感 动作 数据 
库 “ 、 动 作 数据 库 、 三 维 仿真 模块 和 通信 模块 组 成 。 软 件 的 功能 模块 如 图 4-8 所 示 。 
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发 送 指令 和 
数据 正确 ? 


是 否 继续 发 
送 动作 指令 


(结束 
图 4-7 控制 端的 工作 流程 及 数据 交互 


SE EUER 


三 维 仿真 模块 


基于 音乐 情绪 的 
情感 动作 数据 库 


图 4-8 上 位 机 软件 主要 功能 模块 


下 面 ， 就 对 上 位 机 软件 平台 的 主要 功能 模块 进行 说 明 。 

(1) 主 界面 、 动 作 调试 及 动作 数据 库 上 位 机 主 界面 主要 功能 是 进行 机 器 人 的 初始 位 
置 以 及 动作 调试 ; 机 器 人 端 与 PC 控制 端的 串 行 口 通信 的 开关 及 数据 的 监视 ;调试 后 的 动作 
可 以 以 .dat 文件 的 形式 保存 实际 控制 角 动作 数据 或 者 以 相对 动作 数据 保存 在 动作 数据 库 中 ， 
如 图 4-9 所 示 。 
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图 4-9 上 位 机 软件 主 界面 


(2) 音乐 列表 界面 及 情感 动作 数据 库 ”通过 该 界面 可 以 播放 音乐 ,管理 基于 情绪 模型 
的 音乐 数据 库 ' 引 ， 并 可 以 根据 音乐 的 音频 快慢 在 情感 动作 数据 库 中 查找 到 双 足 步行 机 器 人 
的 情绪 参数 ， 在 动作 数据 库 中 查找 与 情绪 系数 最 接近 的 动作 组 ， 自 动 地 向 机 器 人 发 送 与 所 播 
放 音 乐 情感 特征 相符 的 动作 数据 [41 ， 如 图 4-10 所 示 。 根 据 操作 者 想 表 达 的 音乐 情绪 在 数 
据 库 中 显示 与 所 选 情绪 最 为 接近 的 动作 数据 进行 动作 的 编排 汪 ， 并 且 保 存 动作 组 。 同 时 可 
以 根据 所 选 的 机 器 人 ID 号 查找 数据 库 中 的 机 器 人 初始 位 置 ， 从 而 生成 针对 该 机 器 人 的 动作 
数据 组 下， 如 图 4-11 所 示 。 

(3) 三 维 仿真 ”根据 双 足 步行 机 器 人 的 实际 结构 建立 的 三 维 立体 模型 ， 可 以 在 虚拟 的 
环境 中 为 双 足 步行 机 器 人 创作 各 种 动作 ， 如 街舞 、 倒 立 等 ， 再 将 得 到 的 动作 数据 下 载 到 双 足 
步行 机 器 人 上 ， 从 而 实现 机 器 人 的 动作 。 

(4) 通信 通过 RS-232 串 行 口 控制 双 足 步行 机 器 人 的 动作 演示 ， 可 以 在 线 地 编排 双 足 步 
行 机 器 人 的 动作 ， 给 双 足 步行 机 器 人 发 动作 数据 ， 发 送 数据 的 同时 ， 在 串口 监控 模块 窗口 中 显 
示 发 送 错误 的 动作 帧 见 图 4-9 ， 并 重新 发 送 该 动作 帧 ， 以 确保 准确 无 误 地 发 送 动作 数据 。 
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图 4-10 上 位 机 软件 音乐 情感 界面 


动作 编排 
机 器 人 号 127 ~| 动作 组 
动作 
动作 
情绪 动作 名 称 
db tb EMITE I - 
o E 
天 =| 46 — HES 
行走 
BE JR 人 | 
动作 组 LEE 
完成 
[ | ”生成 动作 数据 打开 


图 4-11 上 位 机 软件 动作 编排 界面 


4.2.4 ”多 机 器 人 控制 


多 机 器 人 系统 的 通信 是 研究 多 机 器 人 系统 的 基础 ， 由 个 体 机 器 人 组 成 一 个 群体 系统 ， 通 
言 是 必 不 可 少 的 。 多 机 器 人 系统 在 执行 某 项 任务 时 ， 为 了 实现 协调 与 合作 ， 个 体 机 器 人 的 传 
感 需 必须 提供 足够 的 环境 描述 信息 和 其 他 机 器 人 的 信息 ,因此 机 器 人 个 体 之 间或 者 上 层 控制 
和 下 层 合作 之 间 的 通信 是 必要 的 ” 。 机 器 人 之 间 的 通信 方式 主要 有 两 种 ， 即 直接 通信 和 间 
接 通信 。 直 接 通 信 要 求 发 送 和 接收 信息 能 保持 一 致 性 ， 因 此 机 器 人 之 间 需 要 一 种 通信 协议 ， 
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而 且 直 接 通信 时 发 送 方 和 接收 方 必须 同时 在 线 ， 间 接 通 信 没 有 此 项 要 求 。 一 般 来 说 ， 直 接 通 
信和 存在 于 有 智能 的 机 器 人 之 间 ， 而 间接 通信 存在 的 范围 就 比较 大 ， 如 个 体 和 个 体 通信 、 个 体 
和 群体 通信 、 个 体 和 环境 通信 等 。 目 前 ， 大 部 分 关于 多 机 器 人 的 通信 主要 采用 广播 的 方式 ， 
即 个 体 机 器 人 将 自己 的 位 置 和 传感器 信息 以 及 自己 从 事 的 工作 信息 广播 出 去 ， 其 他 个 体 机 咒 
人 可 以 按 自己 的 需要 选择 信息 ， 或 主 控 机 器 人 通过 广播 分 配 任务 等 。 

与 分 层 体系 结构 相对 应 ， 多 机 器 人 系统 的 通信 模型 也 采用 分 层 结构 。 为 了 便于 集中 管 
理 ， 客 户 机 /服务 器 模型 示意 图 如 图 4-12 所 示 。 


蕊 控制 
智能 体 


机 器 人 知 能 体 Las ATE REGE 


图 4-12 ”分 层 通信 模型 示意 图 


在 图 4-12 中 ， 通 信 模 型 总 体 上 采用 两 层 客户 机 /服务 器 C/S 结构 。 控 制 中 心 与 各 机 器 人 
的 通信 服务 器 构成 第 一 层 ， 机 器 人 通信 服务 器 与 功能 模块 构成 第 二 层 。 控 制 中 心 的 通信 服务 
器 负责 与 各 机 器 人 的 通信 服务 器 交互 ， 实 现 信息 的 传递 。 当 收 到 机 器 人 通信 服务 器 的 连接 请 
求 时 ， 总 控制 中 心 通信 服务 器 开启 线程 为 之 服务 ， 同 时 为 其 分 配 端 口号 ， 将 机 器 人 名 称 和 端 
口号 存 入 地 址 表 中 备查 ; 机 器 人 通信 服务 器 是 控制 中 心 的 客户 端 ， 而 对 功能 模块 而 言 ， 它 是 


服务 器 ， 负 责 各 功能 模块 间 的 数据 交互 ， 实 现 分 布 式 计 算 ; 通信 接口 仅 为 客户 端 ， 负 责 指令 
的 生成 和 解释 ， 功 能 模块 通过 通信 接口 发 送 和 接收 数据 。 

为 了 提高 系统 适应 环境 的 能 力 ， 整 个 系统 动态 可 扩充 。 关 于 模型 的 动态 可 扩充 能 力 ， 我 
们 可 以 将 其 分 成 两 层 理解 ， 一 是 机 器 人 系统 的 动态 接 人 ， 由 于 采用 了 便于 管理 的 C/S 结构 
模型 ， 在 系统 运行 过 程 中 需要 接 入 机 器 人 系统 时 ， 该 机 器 人 的 调度 


进程 向 控制 中 心 进程 发 出 接 和 请求， 控制 中 心 进程 启动 新 线程 为 之 
ATTE AXE [ac H AE /MEJH E 


服务 ， 当 机 器 人 系统 退出 时 ， 控 制 中 心 进程 结束 相应 的 服务 线程 ， 
释放 资源 ， 与 此 类 似 ， 在 机 器 人 系统 内 部 ， 由 于 机 器 人 的 状态 改变 ， 
需要 启动 或 停止 部 分 工作 进程 (线程 )。 启 动工 作 进程 时 ,该 进程 所 
在 机 器 人 的 调度 进程 向 工作 进程 发 出 启动 命令 ; 停止 工作 进程 时 ， 
则 发 出 命令 将 该 工作 进程 挂 起 。 工 作 进 程 如 图 4-13 所 示 。 图 4-13 ”工作 进程 结构 
每 个 工作 进程 都 包含 两 部 分 : 网络 接口 和 功能 算法 实现 ,算法 实现 部 分 并 不 需要 考虑 通 
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信和 问题 ， 它 仅 关注 功 能 的 算法 实现 ， 通 过 定义 接口 规范 ， 可 以 保证 功能 算法 部 分 的 较 强 封装 
性 ， 从 而 使 算法 的 可 移植 性 等 功能 大 幅度 加 强 。 


4.3 总 体 设 计 架 构 


我 们 希望 双 足 机 器 人 平台 可 以 进行 基于 传感器 的 特征 提取 ， 对 各 种 环境 信息 和 用 户 意图 
及 情感 信息 获取 的 多 模式 行为 关联 融合 ， 从 而 实现 个 性 化 交互 的 双 足 机 器 人 控制 端 软件 的 总 


体 设 计 架 构 ， 如 图 4-14 所 示 。 
拟人 机 器 人 行为 表现 
行为 数据 库 | CO | 多 模式 行为 关联 融合 


户 意 赂 及 情感 信息 获取 


视频 初级 特征 频 初 级 特征 其 他 信息 初级 特征 


和 征 提取 工具 


音频 的 获 
多 种 传感器 信 


习 像 /关键 帧 六 
注 区 域 提取 


语义 关键 字 识 | 电 的 获取 
别 与 分 析 


图 4-14， 双 足 步 行 机 器 人 系统 的 总 体 设 计 架 构图 


4.4 小 结 


本 章 介 绍 了 用 于 音乐 表演 研究 的 双 足 步行 机 器 人 试验 平台 ,将 其 控制 系统 分 为 上 、 下 两 
层 控制 。 上 层 为 控制 端 软件 的 软件 架构 ， 由 动作 调试 模块 、 音 乐 情绪 数据 库 、 动 作 数 据 库 、 
通信 和 模块、 动作 编排 模块 组 成 ， 下 层 为 整体 硬件 架构 ， 包 括 控 制 电路 、 多 机 器 人 通信 协议 与 
控制 端 通信 的 各 种 控制 运行 模式 。 提 出 初始 位 置 的 概念 用 于 软件 平台 的 初始 化 设 定 模块 ， 以 
克服 机 器 人 关节 有 各 自 不 同 的 初始 位 置 的 问题 ， 使 机 器 人 的 动作 数据 具有 通用 性 。 这 是 我 们 
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进行 多 机 器 人 标准 化 动作 表演 的 基础 。 最 后 ， 提 出 了 基于 传感器 特征 提取 各 种 环境 信息 及 
感 信息 获取 的 多 模式 行为 关联 融合 ， 从 而 实现 个 性 化 交互 的 双 足 机 器 人 和 平台 E 
构 。 
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ON tA A t Nel 


453 XU THU ds AT TTA ERRER 


通过 前 面 的 学 习 ， 我 们 已 经 掌握 了 双 足 步行 机 器 人 的 基本 技术 和 方法 ， 并 根据 实验 平台 
进行 有 针对 性 的 分 析 和 研究 ， 但 要 双 足 步行 机 器 人 模仿 人 类 高 级 智能 ， 就 要 研究 双 足 步行 机 
器 人 的 行为 生成 技术 。 本 章 重 点 讲述 拟人 情感 建 模 和 拟人 行为 生成 。 

目前 人 工 心理 与 情感 计算 应 用 研究 是 拟人 机 器 人 技术 的 重要 内 容 之 一 “7 。 如 何 将 情感 
转移 的 控制 思想 与 机 器 人 具体 控制 技术 相 结合 是 高 科技 技术 的 象征 …” 。 本 章 将 从 双 足 步行 
机 器 人 的 多 智能 体 控制 的 实现 、 情 感 模型 的 搭建 、 行 为 决策 的 设计 、 情 绪 炉 的 选取 、 语 
音 数据 库 的 设计 与 机 器 人 动作 等 方面 进行 详细 描述 。 这 是 基于 第 4 章 介 绍 的 双 足 步行 机 器 人 
实验 平台 来 展开 的 。 该 机 器 人 共有 17 个 自由 度 。 通 过 计算 机 离线 计算 机 器 人 的 行为 数据 ， 
进而 协调 17 个 舵 机 的 运动 ， 从 而 实现 对 机 天 人 的 控制 。 


5.1. 多 智能 体 控制 的 实现 


5.1.1 多 智能 体 的 特点 


随 着 计算 机 技术 、 超 大 规模 集成 电路 、 控 制 理论 、 人 工 智 能 理论 、 传 感 需 技术 等 的 不 断 
成 熟 和 发 展 ， 由 多 学 科 交 叉 而 形成 的 机 器 人 学 研究 也 进入 了 一 个 轩 新 的 阶段 。 从 可 编程 的 、 
示 教 再 现 型 的 工业 机 器 人 到 具有 一 定 传 感 能 力 、 一 定 适 应 能 力 的 机 器 人 ， 再 到 配备 多 种 先进 
传 感 需 、 具 有 较 强 的 适应 能 力 的 智能 机 器 人 ， 机 器 人 学 的 研究 工作 经 历 了 一 个 从 简单 到 复 
杂 ， 从 功能 单一 到 功能 多 样 ， 从 工业 制造 领域 到 军事 侦察 、 核 工业 、 航 空 航天 、 服 务 业 、 医 
疗 器 械 、 基 因 工 程 等 诸多 领域 的 过 程 。 可 以 预见 ， 在 不 久 的 将 来 ， 机 器 人 技术 在 各 个 领域 的 
应 用 将 会 更 加 广泛 和 深入 。 而 各 种 机 咒 人 系统 在 实际 工作 中 的 广泛 应 用 又 为 机 器 人 学 提出 了 
新 的 要 求 和 新 的 研究 课题 。 多 机 此 人 系统 的 研究 就 是 在 这 些 新 的 应 用 需求 驱动 下 提出 的 ， 并 
随 着 机 融 人 学 的 不 断 发 展 而 逐渐 成 为 机 顺 人 学 研究 的 一 个 重要 分 文 。 

在 机 器 人 研究 的 早期 ， 单 机 器 人 的 结构 、 运 动 学 、 控 制 和 信息 处 理 是 研究 的 重点 。 随 着 
机 器 人 技术 的 发 展 ， 单 个 机 器 人 的 能 力 、 鲁 棒 性 、 可 靠 性 、 效 率 等 都 有 很 大 的 提升 。 但 面 对 
一 些 复杂 的 、 需 要 高 效率 的 、 并 行 完 成 的 任务 时 ， 单 个 机 器 人 则 难以 胜任 。 为 了 解决 这 类 问 
题 ， 机 器 人 学 的 研究 一 方面 要 进一步 开发 智能 更 高 、 能 力 更 强 、 和 柔性 更 好 的 机 器 人 ， 另 一 方 
面 要 在 现 有 机 器 人 的 基础 上 ， 通 过 多 个 机 器 人 之 间 的 协调 工作 来 完成 复杂 的 任务 。 

多 机 器 人 系统 是 机 器 人 学 在 新 的 应 用 需求 驱动 下 提出 的 、 有 具有 重要 理论 价值 和 应 用 前 景 
的 研究 方向 ”。 从 系统 的 角度 出 发 ， 对 多 个 机 器 人 组 成 的 群体 进行 深入 研究 ， 充 分 发 挥 多 
机 器 人 系统 所 具有 的 系统 元 余 、 并 行 工作 、 资 源 分 布 等 优势 。 

多 机 器 人 系统 的 研究 是 从 单个 机 器 人 系统 的 研究 扩展 开 来 的 ,但 区 别 于 单个 机 器 人 系 
统 ， 多 机 顺 人 系统 的 特点 可 以 概括 如 下 : 

(1) 空间 分 布 多 个 机 器 人 可 以 在 工作 空间 的 不 同 区 域 同时 工作 "| 。 
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(2) 功能 分 布 ”功能 不 同 的 机 器 人 或 具有 不 同 任务 (目标) 的 多 机 器 人 可 以 协同 工作 。 

(3) 时 间 分 布 多 个 机 器 人 可 以 执行 时 间 分 布 的 任务 。 

(4) 信息 分 布 多 个 机 器 人 可 以 具备 相同 的 知识 或 不 同 的 知识 ， 通 过 通信 ， 协 作 机 器 
人 可 以 进行 知识 的 交换 和 学 习 5 。 

(5) 资源 分 布 ”多 机 器 人 系统 中 各 机 器 人 可 以 具有 不 同 的 传感器 和 执行 器 。 
5.1.2 多 机 器 人 动作 协调 设计 及 转化 程序 的 实现 

双 足 步行 机 器 人 的 动作 主要 是 通过 17 个 能 机 共同 协调 转动 来 得 以 实现 的 。 每 个 动作 包 
& 1 个 速度 位 和 17 个 舵 机 的 角度 值 ， 算 作 一 帧 动作 。 一 个 基本 动作 包含 若干 帧 动作 ， 这 些 
帧 也 就 是 字符 都 存放 在 相应 数组 中 ， 通 过 上 位 机 将 数据 完全 发 送 到 下 位 机 ， 如 图 5-1 所 示 。 

号 | DATA | SPEED | CH1 | CH? | CH3 | CH4 | CHS | CHE | CHT | CHS | CH9 | CHI + 


1 IATA È 166 160 84 T8 5 B az au BT 55 

z IATA È 1B1 141 a4 T8 z zi 5z TG 11ü 12B 

3 IATA 3 161 136 g4 99 z zi Baz 95 11ü 125 

E! DATA 日 161 136 a4 ag 之 z1 az gs 10T 145 

5 DATA BEB 161 136 Ba ag 114 2T az gs Ta 149 

B DATA 66 161 136 a4 ag z zl az 36 15T 118 

T DATA 6 161 136 84 ag 2 zl az 36 15T 116 ~ 
4 | | + 
当前 状态 ERREA AHE TS | 


运行 | sù | ”顺序 | Et | 


图 5-1 上 位 机 控制 平台 显示 动作 数据 
对 于 实验 所 运用 到 的 双 足 步行 机 器 人 的 基本 动作 可 以 分 解 为 如 图 5-2 所 示 动 作 。 


初始 位 置 1 帧 数据 


HIRIE nn 帧 数据 


初始 位 置 1 帧 数据 


图 5-2 ”机 器 人 基本 动作 的 分 解 
初始 动作 可 以 作为 双 足 步行 机 器 人 的 复位 动作 ， 也 就 是 任何 基本 动作 的 开始 和 收尾 都 是 
以 此 动作 为 结尾 。 这 里 我 们 选择 初始 位 置 ( Homeposition ) 为 双 足 步行 机 器 人 坚 直 站 立 的 姿 
态 ， 如 图 5-3 所 示 。 因 此 ， 双 是 步行 机 器 人 的 基本 动作 设计 主要 放 在 了 除了 初始 位 置 的 其 他 
WE, 
&eaMWESETETOUE THU ABUTIGE, HAER E OSUEZPTTB Uds A REAR 
ZMP 作为 稳定 行走 的 判 据 。 当 双 足 机 构 处 于 动态 平衡 时 ，ZMP 和 脚底 所 受 地 面 反 力 的 压力 
中 心 (Center of Pressure, CoP) 是 重合 的 。 因 此 可 以 根据 检测 到 的 地 面 反 力 信息 ， 计 算 CoP, 
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通过 控制 策略 调整 ZMP 和 CoP 的 位 置 ， 使 两 者 重合 ， 实 现 机 器 人 的 动态 稳定 行走 。 行 走 模 
型 如 图 5-4 所 示 。 


惯性 力 


实际 地 面 
| 
[9] X 
实际 ZMP 
图 5-3 ”机 器 人 初始 位 置 图 5-4 ZMP 行走 模型 示意 图 


根据 力学 原理 可 知 ， 当 物体 处 于 静止 状态 时 ， 其 平衡 的 充 要 条 件 是 其 重心 在 地 面 上 的 投 
影 落 在 其 支撑 面 内 ， 而 广义 地 讲 ， 当 物体 处 于 运动 状态 时 ， 其 平衡 的 必要 条 件 是 所 受 重力 与 
惯性 力 的 合力 的 延长 线 通 过 其 文 撑 面 内 (该 合力 的 延长 线 与 支撑 面 的 交点 称 为 ZMP) 。 

以 前 实验 室 中 传统 的 调节 机 器 人 的 动作 都 是 用 手动 调节 上 位 机 控制 平台 的 滚动 条 控件 来 
进行 编写 的 ， 这 样 调节 机 器 人 的 动作 ， 对 于 单个 机 器 人 来 讲 ， 优 点 是 精确 ， 符 合 精确 的 步 态 
发 生 模 型 的 要 求 。 例 如 实现 双 足 步行 机 器 人 的 行走 ， 为 了 符合 ZMP 理论 要 求 ， 需 要 精确 地 
拖 动 上 位 机 控制 平台 的 滚动 滑 块 来 进行 调解 。 

然而 对 于 多 机 器 人 的 动作 协调 设计 ， 则 需要 有 更 加 有 效率 的 编写 机 器 人 动作 文件 的 方 
式 ， 而 不 能 拘泥 于 以 前 的 传统 滚动 条 的 编写 方法 。 为 了 使 机 器 人 的 动作 协调 设计 得 以 顺利 实 
现 ， 新 的 机 器 人 动作 编写 方法 是 必需 的 。 

在 研究 本 实验 平台 的 双 足 步行 机 器 人 的 动作 当中 ， 每 台 机 器 人 的 动作 即使 表达 一 样 ， 但 
它们 所 对 应 的 动作 数据 却 不 尽 相 同 ， 这 是 由 于 每 台 机 器 人 的 初始 位 置 所 对 应 的 动作 数据 不 
同 ， 这 是 舵 机 本 身 性 能 所 带 来 的 无 法 避免 的 硬 伤 。 换 名 话说， 用 17 个 舵 机 组 成 新 机 器 人 的 
初始 位 置 数据 就 与 其 他 17 个 相同 性 能 品牌 的 舵 机 组 成 的 已 有 机 器 人 的 初始 位 置 不 同 。 

在 反复 的 学 习 与 研究 中 ， 从 双 足 步行 机 器 人 每 帧 的 动作 数据 之 间 着 手 分 析 ， 得 出 了 双 足 
步行 机 器 人 新 动作 转化 的 公式 。 

在 此 令 机 器 人 实际 动作 时 的 舵 机 角度 值 (4 ) 与 初始 位 置 的 角度 值 (H,) . Boss Auf 
动作 时 舵 机 转 动 的 角度 值 (R) 三 者 之 间 的 关系 ， 得 出 机 器 人 实际 动作 时 角度 值 关 系 公 式 : 

R, +H, -A, (5-1) 

在 三 个 变量 中 ， 只 有 舵 机 转动 的 角度 值 R, 是 恒定 不 变 的 。 这 样 就 可 以 将 公式 进行 转化 ， 
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MURTAK RREFERA AB 2 EROS 55 C8 Us ALS) s PEG B5] X P 

LEANA KRETALA ERR (4 ) 与 初始 位 置 角度 值 (H), 、 机 器 人 进行 动 
作 时 舵 机 转动 的 角度 值 (R,)， 那 么 可 以 将 式 (5-1) 转化 成 

R, -A, - H, (52) 
ALARA Scb MER AEDA BER. (4,) 与 初始 位 置 角 度 值 (于)、 机 右 人 进行 动 
作 时 舵 机 转动 的 角度 值 (R,), XATA FIHLA R, SER, R 与 R, 相同 ， 即 
R, =R, (5-3) 
则 得 到 
A, - H, - A, - H, (54) 
调试 机 器 人 的 新 动作 就 是 求 新 机 器 人 的 设计 动作 时 的 能 机 角度 值 4, 。 

若 已 知 某 台 双 足 步行 机 吉 人 实际 动作 时 的 舵 机 角度 值 (4 ) 与 初始 位 置 角度 值 (Hi )、 
通过 调试 机 器 人 的 三 大 步骤 的 第 一 步 ， 可 以 得 到 初始 位 置 角度 值 (n), BE SUSMEP EA 
式 为 

A, =A, -Hi +H, (5-5) 

这 个 公式 就 是 双 足 步行 机 器 人 新 动作 转化 程序 的 算法 精髓 。 

在 VC + + 环境 中 ， 实 现 双 足 步 行 机 咒 人 新 动作 转化 程序 的 主要 函数 如 下 : 

void CNewActionDlg: : OnChange( ) 

| 

// 'TODO: Add your control notification handler code here 

CFile Chfile; 

unsigned char temp| 65535 ] ; 

unsigned char uchData[ 3600] [18] ; 

int Num data; 

int i,j; 

if( Opentest && Savetest ) 

| 

BOOL test = Chfile. Open( OpenFileName , CFile: : modeRead ) ; 
UINT nbytes = Chfile. Read( temp ,65535) ; 
Chfile. Close( ) ; 


test = 
Chfile. Open ( SaveFileName , CFile : : modeWrite | CFile: : modeCreate ) ; 
Num data = nbytes/18; // 求 得 文件 数据 总 行 数 
int unum = 0; 
for(i = 0; i < Num data; i+ +) 
| 
unum + +; // 计 数 
for(j = 05j <18;j+ + )// 给 发 送 的 数组 赋值 
| 
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uchData[i]|j] = temp[18 *i+j]; 

| 

UpdateData(true ) ; 
unsigned int 
Hompl[17] = {m Dhl,m Dh2,m Dh3,m Dh4,m Dh5,m Dh6,m Dh7,m Dh8,m _ 
Dh9,m Dhl0,m Dhll,m Dhl2,m Dhl3,m Dhl4,m Dhl5,m Dhl6,m Dh17};// 已 
有 机 器 人 的 初始 位 置 的 17 个 数据 放 在 数组 Hompl [ 17 ] 中 
unsigned int 
Hompnew[17] 2ím Chl,m Ch2,m Ch3,m Ch4,m Ch5,m Ch6,m Ch7,m Ch8,m _ 
Ch9,m Chl0,m Chll,m Chl2,m Chl3,m Chl4,m Chl5,m Chl6,m  Chl7] ; /新 
机 器 人 的 初始 位 置 的 17 个 数据 放 在 数组 Hompnew [ 17 ] F 

for(j = 1;j<18;j+ +) 


| 
if(uchData[1][ j] + Hompnew[j -1] < =Hompl[j-1]) 
uchData[ i][j] 21; /机 器 人 舵 机 角度 值 不 能 小 于 1 ,强行 令 uchData[ i][ j] 21 
else uchData[ i] [j] + = Hompnew[ j -1] - Hompl[j -1]; 
// A2 = Al- HI + H2 公式 算法 的 程序 中 的 实现 
if(uchData| 1][j] > =180) 
uchData[ i][j] 2179; 


| 
Chfile. Write( uchData,18 * unum) ; 
Chfile. Close( ) ; 


OpenFileName - ^0 '; 

SaveFileName ='\0 '; 

MessageBox ( " ed p JJ" ," 转换 结束 " ,MB OK); 

Savetest = FALSE;// 将 “存储 成 功 标志 ”重新 设 定 为 false 

Opentest = FALSE;// 将 “文件 打开 成 功 标志 ”重新 设 定 为 false 

| 

由 此 ， 多 机 器 人 的 新 动作 转化 程序 就 实现 了 ， 程 序 运行 界面 如 图 5-5 所 示 ， 大 大 提高 新 
组 装机 器 人 的 动作 文件 编写 效率 。 这 也 为 双 足 步行 机 器 人 的 多 智能 体 控制 做 出 了 支持 ， 为 机 
器 人 团队 表演 和 “ 千 手 观音 ”表演 做 出 了 相应 充足 的 准备 。 


5.1.3. “和 王 手 观音 ”机 器 人 多 智能 体 控制 的 实现 


通信 是 机 器 人 之 间 进 行 交 互 和 组 织 的 基础 。 通 过 通信 ， 多 机 器 人 系统 中 各 机 器 人 了 解 其 
他 机 器 人 的 意图 、 目 标 和 动作 以 及 当前 环境 状态 等 信息 ， 进 而 进行 有 效 的 控制 ， 协 作 完 成 任 
务 。 一 般 来 说 ， 机 器 人 之 间 的 通信 如 图 5-6 所 示 ， 可 以 分 为 隐 式 通信 和 显 式 通信 两 类 。 
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设置 初始 位 置 


TREES A] - 
iE : | 训 览 | 
srt as AtA D 
iE. 训 览 


E 


选择 动作 净 件 


模版 机 器 人 动作 : JE 
保存 动作 路 径 : | BE | 


图 5-5 新 动作 转化 程序 的 运行 界面 


机 器 人 
hn 


ka ue cmi 
1 3 


图 5-6 多 机 器 人 系统 的 通信 


使 用 隐 式 通信 的 多 机 器 人 系统 通过 外 界 环 境 、 自 身 传感器 来 获取 所 需 的 信息 ， 并 实现 相 
互 之 间 的 协作 ， 机 器 人 之 间 没 有 通过 某 种 共有 的 规则 和 方式 进行 数据 转移 和 信息 交换 来 实现 
特定 信息 的 传递 。 在 使 用 隐 式 通信 的 多 机 器 人 系统 中 ， 由 于 各 机 器 人 相互 之 间 不 存在 数据 、 
信息 的 显 式 交换 ， 所 以 多 机 器 人 系统 可 能 无 法 使 用 一 些 高 级 的 协调 协作 策略 ， 从 而 影响 了 其 
完成 某 些 复杂 任务 的 能 

使 用 显 式 通信 的 多 机 器 人 系统 利用 特定 的 通信 介质 ， 通 过 某 种 共有 的 规则 和 方式 实现 特 
定 信息 的 传递 ， 因 而 可 以 快速 、 有 效 地 完成 各 机 器 人 间 数 据 、 信 息 的 转移 和 交换 ， 实 现 许 多 
在 隐 式 通信 下 无 法 完成 的 高 级 协调 协作 策略 。 

与 已 有 的 通信 系统 不 同 ， 此 系统 不 需 一 个 中 心服 务 顺 或 基站 的 存在 ， 符 合 分 布 式 机 器 人 
系统 的 基本 特点 和 要 求 ， 并 通过 共享 无 线 通 信 通 道 的 方式 实现 了 机 器 人 之 间 的 数据 通信 。 
EiichiYoshida 等 人 从 通信 容量 和 成 本 的 角度 对 多 机 器 人 系统 的 局 部 通信 进行 了 研究 ， 提 出 了 
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在 许多 机 器 人 随机 发 送 消 息 的 环境 中 对 多 机 器 人 系统 局 部 通信 效率 进行 优化 的 方法 ， 以 传输 
等 待 时 间 最 小 为 目标 ， 通 过 使 用 信息 成 功 传送 的 概率 进行 分 析 计 算 ， 推 导出 了 各 机 器 人 最 优 
的 通信 范围 。 多 机 器 人 系统 的 显 式 通信 虽然 可 以 强化 机 器 人 之 间 的 协调 协作 关系 ， 但 也 存在 
以 下 问题 : 各 机 器 人 的 通信 过 程 延 长 了 系统 对 外 界 环 境 变化 的 响应 时 间 ; GB frr DES P ni f 
机 器 人 之 间 的 信息 传递 、 交 换 出 现 瓶 颈 ; 随 着 多 机 器 人 系统 中 机 器 人 数目 的 增加 ， 通 信和 所 需 
时 间 大 量 增 加 ， 信 息 传递 中 的 瓶颈 问题 更 为 突出 。 

隐 式 通信 与 显 式 通信 和 是 多 机 器 人 系统 各 具 特 色 的 两 种 通信 模式 ， 如 果 将 两 者 各 自 的 优势 
结合 起 来 ， 则 多 机 器 人 系统 就 可 以 灵活 地 应 对 各 种 动态 未 知 环境 ， 完 成 许多 复杂 任务 。 利 用 
显 式 通信 进行 少量 的 机 器 人 之 间 的 上 层 协 作 ， 通 过 隐 式 通信 进行 大 量 的 机 器 人 之 间 的 底层 协 
调 ， 在 出 现 隐 式 通 信 无 法 解决 的 冲突 或 死 锁 时 ， 再 利用 显 式 通信 进行 少量 的 协调 工作 加 以 解 
决 。 这 样 的 通信 结构 既 可 以 增强 系统 的 协调 协作 能 力 、 容 错 能 力 ， 又 可 以 减少 通信 量 ， 避 免 
通信 中 的 瓶颈 效应 。 

每 个 机 器 人 其 实 对 应 的 就 是 其 中 的 单个 智能 体 ， 通 过 上 位 机 程序 和 无 线 通信 模块 来 对 多 
个 机 器 人 进行 控制 ， 实 现 了 一 对 多 的 多 智能 体 控制 ， 发 送 数据 的 函数 程序 编写 如 下 : 
DWORD CROBCONDlg: :WorkThread( ) /发 送 数据 


uchTemp[ 0 ] = Oxff 
uchTemp[ 1 ] = Oxfe; 
uchTemp[2] 2m RobolD; —— // 存放 机 器 人 公共 ID = 127 以 达到 同时 对 多 智能 体 控 


制 
] 20x04; 
] =m unDataGroupNum ; // 存 放 动 作 组 号 


uchTemp[ 3 
4 

uchTemp[ 5 ] = ( unsigned char)i; 
6 


uchTemp| 
uchTemp[ 6 ] = ( unsigned char) unum; 

uchTemp[ 7 | = uchData[ 1] [0] ; 

for(int j 28;j < Length;j + +) // 数 据 赋值 

uchTemp[j] = uchData[i][j -7] * MAX NUM/MAX DEGREE; 
uchTemp[ 25 | = CheckSum ( uchTemp ,26) ; 


每 台 机 器 人 都 有 属于 自己 的 ID 号 ， 每 个 ID 号 就 如 同 它们 自己 的 名 字 。 在 上 位 机 界面 
中 ， 当 我 们 输入 ID 号 时 ， 相 应 的 机 器 人 就 会 作出 动作 ， 这 就 实现 了 “一 对 一 ”的 控制 。 那 
么 对 于 一 对 多 的 控制 ， 我 们 规定 了 机 器 人 公用 的 ID 号 ， 当 我 们 输入 公用 ID 号 时 ， 所 有 接 通 
电源 的 机 器 人 都 会 受到 控制 ， 这 就 是 所 谓 “ 一 对 多 ”的 控制 。 本 书 中 ， 使 用 五 台 双 足 步行 
机 器 人 完成 协调 动作 表演 ， 站 位 如 图 5-7 所 示 。 

在 完成 了 同时 对 双 足 步行 机 器 人 的 控制 后 ， 而 “ 千 手 观音 ”的 动作 表演 往往 是 分 时 间 
差 的 ， 那 么 需要 引进 “ 延 时 ”的 概念 ， 如 图 5-8 所 示 。 让 前 排 的 机 器 人 先 动 起 来 ,后 排 的 逐 
个 再 动 ， 整 体 效果 就 出 现 了 “ 千 手 观音 ”表演 的 效果 ， 如 图 5-9 所 示 。 


延 时 1.2s 


图 5-7 千 手 观音 表演 时 的 站 位 


延 时 2.4s 


延 时 3.6s 


延 时 4.8s 


5-8 ” 延 时 思想 设计 千 手 观音 动作 
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图 5-9 千 手 观音 表演 时 的 效果 


5.2 ” 双 足 步行 机 器 人 的 情感 模型 、 行 为 决策 及 情绪 炳 


5.2.1 隐 马 尔 可 夫 模 型 


相对 于 情绪 状态 自发 转移 过 程 ， 情 绪 状 态 刺激 转移 过 程 则 显得 更 加 重要 。 根 据 心 理学 理 
论 ， 在 有 外 界 情感 信息 刺激 的 情况 下 ， 情 感 状态 主要 体现 在 情绪 的 变化 ， 而 情绪 的 变化 又 受 
到 多 方面 的 影响 ， 概 括 地 说 ， 主 要 由 外 界 情 感 当前 心情 状态 
言 息 的 刺激 ( 类型、 强度) 、 当 前 心情 状态 以 及 
情感 性 格 三 个 因素 共同 作用 而 发 生 影响 ， 其 基 | 外 界 情 感 情感 机 器 的 

P E 信息 的 刺激 情结 状态 的 
本 的 模型 框架 如 图 5-10 所 示 。 产生 与 变化 

隐 马 尔 可 夫 链 ( Hidden Markov Model, 
HMM) 是 在 马尔 可 夫 链 的 基础 上 发 展 起 来 的 。 
由 于 实际 问题 比 Markov 链 模 型 所 描述 的 更 为 复 图 5-10 情绪 状态 刺激 转移 过 程 基 本 模型 框图 
2e, 观察 到 的 事件 并 不 是 与 状态 一 一 对 应 ， 而 
是 通过 一 组 概率 分 布 相 联系 ， 这 样 的 模型 就 称 为 HMM。 它 是 一 个 双重 随机 过 程 ， 其 中 之 一 
是 Markov 链 ， 这 是 基本 随机 过 程 ， 它 描述 状态 的 转移 。 另 一 个 随机 过 程 描述 状态 和 观察 值 ， 
不 像 Markov 链 模型 中 的 观察 值 和 状态 一 一 对 应 ， 因 此 不 能 直接 看 到 状态 ， 而 是 通过 一 个 随 
机 过 程 去 感知 状态 的 存在 及 特性 。 因 而 称 之 为 “ 隐 ”Markov 模型 ， 即 HMM, 

一 个 HMM 可 以 由 下 面 的 五 个 参数 描述 .: 
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N: 模型 中 Markov 链 状态 的 数目 。 记 个 状态 为 e, Oy, d c 时刻 Markov 链 所 处 
REH qu. SA qu 属于 (0, 6, 7, 0). 

M: 每 个 状态 对 应 可 能 的 观察 值 的 数目 ， 记 MM 个 观察 值 为 V, se, Vy, do c ANR 
到 的 观察 值 为 0,， 其 中 0, 属于 (V, …, Vus 


m: 初始 位 置 概率 矢量 
a -(mTeymy) (5-6) 
式 中 7,=P(g,=0.,) 1<i<N 
A: 状态 转移 概率 矩阵 
A z (aj) xxx (5-7) 
式 中 aj - P(q,,, 7 0,q, =0;) ]zi;«N 
观察 值 概率 矩阵 
B = (b) vsu (5-8) 


式 中 b, -P(0;-V,lq, -6)1 &j& N,1 «kx M 
由 此 ， 可 以 记 一 个 HMM 为 
AZ(N,M,m,A,B) (5-9) 
或 简写 为 
A-z(m,A,B) (5-10) 
更 形象 地 说 ，HMM 可 以 分 为 两 个 部 分 ， 一 个 是 Markov f£, Ha, A 描述 ， 产生 输 出 状 
态 序 列 ; 男 一 个 是 随机 过 程 ， 由 B 描述 ， 产 生 的 输出 为 观察 值 序列 ， 如 图 5-11 所 示 , 7 为 


观察 值 时 间 长 度 。 
mm Leurs 
ERIS 
MEETS 


图 5-11 HMM 结构 示意 图 
5.2.2 ”情感 模型 及 行为 决策 的 设计 


对 于 双 足 步行 机 如 人 的 情感 来 讲 ， 由 于 只 有 通过 其 动作 表演 来 表达 其 个 性 ， 所 以 相 比 带 
有 表情 机 顺 头 的 机 器 人 在 情感 的 选择 方面 要 狭 罕 得 多 ， 所 选择 的 情感 通过 实验 论证 ， 只 有 
“平静 ”、“ 喜 悦 ”、“ 怒 惧 ”、“ 俩 怒 ” 四 个 情感 状态 适合 ， 而 其 他 的 情感 状态 有 待 于 进一步 
的 研究 探讨 。 

在 双 足 步行 机 器 人 情感 建 模 当 中 ， 首 先 要 寻找 起 始 状 态 ， 因 为 所 有 的 过 程 都 需要 一 个 起 
点 。 通 过 对 自然 人 的 情感 状态 理解 ， 在 没有 外 办 刺激 信号 的 作用 下 ， 人 一 般 都 会 平静 ， 对 于 
双 足 步行 机 器 人 的 情感 设置 也 是 一 样 的 道理 ， 因 此 双 足 步行 机 器 人 的 初始 状态 被 定 为 “ 平 
静 ” 状 态 。 而 其 他 状态 都 是 与 “平静 ”状态 双向 相通 ， 如 图 5-12 所 示 。 

那么 其 他 状态 之 间 的 转化 就 需要 通过 平静 状态 来 进行 过 渡 ， 而 不 允许 随意 两 个 状态 之 间 
进行 转化 。 图 5-12 所 示 外 周 的 状态 都 属于 间接 相连 ， 其 中 单 弧 形 线 表示 这 两 个 状态 可 以 间 
接 转 化 ， 而 双向 箭头 表示 这 两 个 状态 可 以 直接 转化 。 

基本 的 状态 转化 划分 见 表 5-1 。 


Markov 链 (地 ,人 


E 
a 
iR 
Q 
ES 


RETH 
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表 5-1 基本 情感 的 状态 转化 


序号 状态 转化 
1 平静 一 喜悦 
2 Yit 
3 3H R4 
4 FHRL— PS cte 
5 FUBL— PME — RM 
6 Ute E it — 4 
7 喜悦 一 平静 
8 愤怒 一 平静 
9 恐惧 一 平静 
10 Ite cp ng 
11 恐惧 一 平静 一 喜悦 
图 5-12 ”情感 状态 模型 | n ë | aee O 


而 具体 的 情况 ， 则 要 比 上 述 的 基本 情感 状态 转化 要 复杂 并 具有 随机 性 。 由 此 通过 将 上 述 
12 种 基本 情感 状态 为 元 素 ， 来 进行 任意 的 组 合 搭配 ， 就 能 大 致 模拟 现实 中 的 情感 状态 转移 
的 情况 。 

行为 决策 设计 如 图 5-13 所 示 。 


图 5-13 行为 决策 设计 


一 般 来 说 ， 对 于 双 足 机 器 人 的 情感 转移 控制 以 及 行为 实现 可 以 大 致 分 为 三 部 分 : 信息 采 
集 融 合 层 、 行 为 规则 层 、 决 策 层 。 首 先 ， 信 息 采 集 融 合 层 包含 了 几 种 外 界 刺激 信号 进入 的 途 
径 ， 其 中 包括 语音 方面 的 语音 处 理 模 块 ， n d 通信 方面 的 无 线 网 络 通 
信和 模块 和 红外 超声 等 模块 。 在 这 里 主要 介绍 的 信息 采集 是 通过 语音 处 理 模块 来 实现 的 。 决 策 
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层 的 判断 依据 来 自 于 数据 库 ， 然 后 通过 数据 库 来 连接 行为 规则 层 ， 最 终 连接 到 双 足 步行 机 融 


人 的 各 个 部 分 的 伺服 电动 机 。 

由 于 语音 数据 库 与 情感 方面 的 耦合 还 是 处 于 
初级 阶段 ， 数 据 库 还 无 法 随意 地 通过 一 句 话 而 确 
定 情感 状态 。 例 如 : 对 于 “今天 天 气 不 好 ”、“ 今 
天 天 气 不 错 ” 等 ,语音 数据 库 还 无 法 直接 通过 里 
面 的 关键 词 来 确定 语句 的 赛 几 ， 由 此 本 章 所 介绍 
的 语音 数据 库 还 处 于 人 为 设计 阶段 ， 也 就 是 对 应 
某 个 具体 的 语句 ， 有 相应 的 固定 输出 。 


5.2.3 ”机 器 人 情感 转移 控制 的 具体 实现 


情感 决策 模型 的 结构 如 图 5-14 所 示 ， 外 界 刺 
激 事件 通过 感知 评价 转化 为 情感 诱发 变量 ， 情 感 
诱发 变量 分 别 作用 于 心情 空间 和 情感 空间 ， 同 时 
两 者 在 个 性 因素 的 影响 下 ,使 得 情感 和 心情 状态 
发 生 转移 ， 最 后 以 合成 表情 做 为 情感 状态 输出 。 

在 程序 中 ， 通 过 算法 来 做 为 实现 情感 状态 的 
转移 手段 。 情 感 状 态 可 基本 分 为 : 平静 、 喜 悦 、 
TUER, MEL, HEAR TELLE SUBE, Mex pu^ dA 


NH 
刻 


AEN 


图 5-14 


态 分 别 对 应 一 个 变量 m _ response， 则 可 以 得 到 下 面 的 关系 : 


m response =0 // 平 静 ; 
m response = 1 // 嘉 悦 ; 
m response =2 / BATES s 
m response =3 EST 


可 以 利用 switch 语句 来 设计 条 件 限 制 。 
执行 动作 程序 的 编写 如 下 : 


情感 决策 模型 流程 图 


void CRobotSoftDlg: : DoAction ( unsigned int repeat, BYTE idnum, BYTE ActionNum )///// 


// 'TODO: Add your control notification handler code here 


unsigned char uchTemp| 26 ] ; 

uchTemp[O0 ] = Oxff; 

uchTemp[ 1 | 2 Oxfe; 

uchTemp[2 ] = idnum; 

uchTemp|3 | 20x06; // 正 党 模式 运行 
4 | = ActionNum; // 


uchTemp| 


for(int i 25;1«23;i- +) 


| 
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uchTemp[i] 20x00; 
| 
uchTemp[23] = repeat?6256; ”// 设 定 动作 运行 次 数 
uchTemp| 24 ] = repeat/256; 
uchTemp[25 ] = CheckSum( uchTemp,26) ; 
SendData( uchTemp ,26 ,0 ) ; 


5.2.4 FÆI 


情感 是 表征 生命 体 心智 状态 的 一 种 信息 ， 将 情感 信息 视 为 情绪 过 程 产生 的 观察 序列 并 假 
定 这 种 情绪 过 程 是 一 种 马尔 可 夫 过 程 ，HMM 信和 号 模型 为 描述 情感 信号 处 理 过 程 提 供 了 理论 
从 而 可 以 获得 期 望 的 输出 ; 其 次 ， 对 情感 信号 建 模 可 以 更 好 地 研究 信号 源 一 情绪 过 

， 并 且 可 以 模拟 信号 源 产生 信号 [2 。 如 果 拥 有 了 这 种 情感 信号 模型 ， 就 能 够 预测 信号 将 
ad Eu c Tai c 
到 主 特征 值 ， 那 么 如 何 区 分 呢 ? 每 个 人 的 性 格 特点 决定 了 他 们 的 情感 转移 特点 。 不 同性 格 的 
人 ， 在 这 种 情况 下 ， 从 当前 的 情感 状态 向 其 他 情感 状态 的 转移 速度 快慢 是 不 同 的 。 因 此 ， 有 
必要 引进 情绪 烂 的 概念 ， 在 程序 中 通过 情绪 烂 的 设置 来 控制 机 器 人 转移 情感 的 速度 快慢 。 

Ti FARBE, TETOUUIEX P, [E— TOME Roc TESTS. R RM 

息 带 有 随机 性 ， 即 不 定性 。 为 了 度量 “不 定性 ”， 使 信息 定 A. 1948 香农 (Shannon ) 
& EARS IO XC EA 全 的 黄 基 性 论文 中 ， 建 立 了 定 “不 定性 ”的 函数 式 


H- -C 之 Pag， (5-11) 


式 中 五 一 一 信 源 的 平均 信息 量 ， dim ce i 
信 源 第 i 种 信号 出 现 的 概率 ，; 

C 一 一 与 对 数 的 底 及 单位 选择 有 关 的 常数 。 

香农 的 伟大 贡献 在 于 ， 利 用 概率 分 布 的 理论 给 出 “ 焙 ” 的 严格 定义 。 根 据 香 农 的 定义 ， 
确定 发 生 的 事件 如 “太阳 从 东边 升 起 ”与 确定 不 发 生 的 事件 如 “太阳 从 西边 升 起 ”， 其 炉 都 
是 零 。 只 有 当 发 生 与 不 发 生 的 概率 相同 时 ,事件 的 炉 才 达 到 极 大 ， 其 中 所 蕴涵 的 信息 量 达 到 
最 大 。 

基于 以 上 讨论 ， 由 于 情感 是 信息 的 一 种 ， 于 是 可 以 利用 信息 入 的 方法 去 度量 情感 。 我 们 
来 研究 某 生命 体 的 m 种 情感 ， 其 中 每 种 情感 划分 了 nn 个 级 别 ， 于 是 就 具有 了 n” 个 情感 状 
态 。 令 1=n”"， 那么 情感 空间 中 具有 了 /个 情感 状态 , 设 p，(i =1，2,，…, D 为 第 i 个 情感 
状态 的 出 现 概 率 。 

JE ZEE C T EA RE CON 


e; 2 - C Y, Pgp, (5-12) 
j=1 


式 中 e, ESSI IUE 
P; 一 一 第 i 种 情感 状态 到 第 7 种 情感 状态 的 概率 ; 


C 一 一 与 对 数 底 及 单位 选择 有 关 的 常数 。 
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Mié e A ele PER HERR, BERRUL, RARR, BRERA 
Ais BRAKE, JcHDU— PA RU Tace, TRAR, BRAAI 
清晰 明确 ， 是 情绪 处 于 稳定 状态 的 表示 。 所 以 ， 对 于 不 同 的 人 物 ， 他 们 的 各 种 心理 状态 下 的 
diiit A LI P T M TRO EMERGERE, ORUM, TE A E PER LORS 
人 的 感情 。 

在 这 里 引用 情绪 粹 的 概念 并 进行 相应 简化 ， 以 方便 模拟 机 器 人 的 内 外 向 的 性 格 特征 ， 这 
里 规定 情绪 炉 越 小 ， 机 器 人 的 个 性 趋向 于 内 向 ; 情绪 业 越 大 ， 机 器 人 的 个 性 趋向 于 外 向 ， 见 
表 52。 


表 5-2 情绪 粹 与 动作 循环 次 数 的 转化 表 


Té eis 动作 循环 次 数 Té eth 动作 循环 次 数 
1 3 4 12 
2 6 5 15 
3 9 6 18 


将 上 述 的 表达 通过 程序 流程 图 来 表示 ， 如 图 5-15 所 示 。 


设 星 初始 的 情感 状态 m_moodnum 


确定 机 器 人 的 TD 区 m_idnum 


情感 状态 下 随机 产生 动作 对 


执行 该 情感 状态 下 的 动作 


动作 执行 的 次 数 (n=N)? 


执行 下 一 个 情感 状态 下 的 动作 


图 5-15 具有 情绪 依 的 情感 状态 转移 的 程序 流程 图 


由 此 可 知 ， 情 绪 炉 的 选取 具有 很 重要 的 意义 ， 它 决定 了 个 性 空间 设计 的 效果 。 在 双 足 步 
行 机 器 人 的 情感 转化 与 行为 决策 的 实现 方面 ， 情 绪 烂 的 选择 给 机 絮 人 添加 了 性 格 内 外 向 的 特 
征 ， 使 得 双 足 步行 机 器 人 在 人 工 心理 与 人 工 情感 领域 的 应 用 中 ， 更 接近 人 的 性 格 品 性 。 
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5.3 ” 双 足 步行 机 器 人 的 语 理 控制 


5.3.1 语音 在 双 足 步行 机 器 人 控制 平台 上 的 实现 


双 足 步行 机 器 人 上 位 机 语音 识别 程序 框架 : 

在 程序 的 开始 ， 首 先 要 利用 语音 ( Software Devlopment Kit) SDK 提供 的 Asr SetSystemDir 
O 函数 设置 识别 引擎 工作 的 系统 目录 ， 主 要 是 指定 声学 模型 所 在 的 目录 ， 然 后 利用 Asr 
SysInit( ) 初始 化 语音 识别 系统 。 

如 果 语 音 识 别 系统 初始 化 成 功 ， 则 可 以 利用 Asr — Linelnit( ResultProc ) 函数 来 创建 一 个 
识别 引擎 hLine， 并 指定 该 引擎 识别 结果 出 来 时 的 回调 函数 以 及 用 户 定义 数据 。 

在 本 文中 我 们 回调 函数 的 定义 为 

DWORD ResultProc( HASRLINE hLine, const PASR _ NOTIFY pNotify, DWORD dwUserDa- 
ta); 

其 中 pNotify 是 回调 通知 ， 它 的 结构 体 如 下 : 

typedef struct ASR NOTIFY 

| 

int NotifyType ; 


int data; 

DWORD dwReserve ; 

} ASR _ NOTIFY, * PASR NOTIFY; 

这 个 结构 在 回调 函数 中 返回 和 语音 以 及 识别 结果 相关 的 数据 ， 其 中 NotifyType 为 通知 类 
型 ， 包 括 : 


NOTIFY RESULT 1 // 识 别 结 
NOTIFY VOICE LEVEL 2 // 声 音 大 小 
NOTIFY UTT BEGIN 3 // 一 句 话 开始 
NOTIFY UTT END 4 // 一 句 话 结 


data; 当 NotifyType X NOTIFY VOICE LEVEL 时 ，data 表示 当前 录音 的 大 小 ，Notify- 
Type 为 其 他 值 时 无 意义 。 
dwReserve. 保留 ， 无 意义 。 
成 功 创建 一 个 识别 引 敬 后， 利用 Asr ”GrammarLoad( ) 函数 来 导入 语法 规则 文件 中 的 语 
法 规则 ， 并 对 语法 规则 进行 设置 。 语 法 规则 文件 可 以 由 用 户 按照 语法 规则 的 要 求 依 据 需 要 自 
己 编 写 ， 语 音 识别 所 需要 用 到 的 语法 规则 ， 遵 循 ABNF 范式 (Augmented BNF), 34A W3C 
语法 定义 。 语 法 规则 的 结构 体 如 下 所 示 : 
typedef struct GRAMMAR ACTIVATE 
| 
int nNum; 
char * szRuleName| 100 | ; 
| HASR GRAMMAR, *PHASR GRAMMAR; 
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我 们 可 以 使 用 该 结构 来 设置 、 切 换 、 关 闭 识别 引擎 对 应 的 语法 规则 。 其 中 : 

nNum 是 语法 规则 的 数量 。 

szRuleName 是 语法 规则 的 名 字 ， 一 个 语音 识别 引擎 可 以 设置 多 个 语法 规则 。 

成 功 导 入 语法 规则 后 我 们 利用 Asr — GrammarActivate ( ) 函数 来 激活 语法 规则 ， 设 置 
Asr RecSetAutoWork(true) 由 引擎 内 部 自动 采集 语音 数据 ， 调 用 Asr SetParam( ) 设置 录音 
以 及 引 警 相关 的 参数 ， 调 用 函数 Asr _ RecStartX(hLine) 开 始 自动 识别 。 

端点 检测 到 语音 大 于 系统 设置 的 起 始 话音 音量 并 进行 录音 ， 当 语音 小 于 设置 的 结束 音量 
停止 录音 。 语 音 识别 系统 对 语 首 进行 识别 ,通过 回调 函数 得 到 回调 通知 ， 利 用 Asr GetNBe- 
stResult( ) 获得 识别 结果 。 

如 果 不 再 需要 语音 识别 ， 利 用 Asr ”RecStopX(hLine) 因数 停止 由 Asr RecStartX 函数 开 
启 的 识别 任务 ， 利 用 Asr _ LineRelease( hLine) 关 闭 hLine 语音 识别 引擎 ， 并 且 释 放 其 相关 的 
资源 ， 利 用 Asr SysRelease( ) 退 出 系统 ， 清除 识别 系统 申请 的 资源 。 

安装 语音 合成 软件 InterPhonic CN Rev1.0 版 ,安装 iFlyTTS SDK， 安 装 加 密 狗 配置 程序 
(在 安装 盘 中 ) 。 

数据 源 : 在 系统 DSN 里 注册 数据 源 。 

驱动 : Microsoft access driver( *. mdb), 

数据 库 : WuKongdb. mdb, 

在 系统 DSN 中 注册 数据 源 ， 打 开 控 制 面板 一 管理 工具 一 数据 源 (ODBC) 一 系统 DSN 一 
添加 一 选择 Microsoft access driver( *. mdb) 点击“ 完成 ”后 一 在 数据 源 名 里 输入 dashendb 同时 
在 数据 库 (选择 ) 中 选择 相应 路 径 下 WuKongdb. mdb 即 可 。 

把 串口 1 和 无 线 发 射 絮 连接 起 来 。 

把 Mandarin _ 8KHz3. 0, asrapi. dll, ASRAPI. h, asrapi. lib, Dashen. grm 文件 复制 到 当前 
目录 下 ,在 ve + +link 库 中 加 入 asrapi. jb， 在 工程 中 加 入 ASRAPI. h 文件 。 

编写 语法 规则 : 新 建 一 个 记事 本 命名 为 Dashen. gm， 在 里 面 写 和 : 

$ tlk2(5**5*1...)«0-» $ talks( * * * 1...) «0-»; 

$ talks = 

你 好 | 

你 会 唱歌 吗 | 

你 多 大 了 ; 

Dashen. grm 文件 增加 语法 的 规则 :“$ talks = ”后 面 增 加 要 识别 的 语句 需 顶 行 开 始 ， 以 
“1” 结尾， 文件 的 最 后 一 条 语句 以 “ ; ”结尾 。 否 则 不 能 进行 识别 ! 

#include " stdio. h" 


#include "iostream. h" 


#include "asrapi. h" 

#include "windows. h" 

#define ONLINE _ TEST 

语音 控制 平台 中 的 重要 函数 编写 如 下 : 
// kie ke se se e e e e À LE 2C He pot e UR I ABRE AA e ek e e kk 
Dashen CRobotSoftDlg : : FindFunctionData ( CString str) 


CString strl ,str2 ; 
Dashen Dsl; 

strl = str; 

strl. TrimLeft( ) ; 
strl. TrimRight( ) ; 


// MessageBox ( str) ; 


int Recordcount 20; 
int number ; 


CRecSetFunet FucSet ; 


FucSet. Open( ) ; 


while( ! FucSet. ISEOF( )) 
| 
str2 = FucSet. m _ Question; 
str2. TrimLeft( ) ; 
str2. TrimRight( ) ; 
FucSet. m _ Question. TrimLeft( ) ; 
FucSet. m Question. TrimRight( ) ; 
// for(int j 20; j <strl. GetLength( ) ; j+ +) 


// | 
/ /if( strl. Mid(j,sti2. GetLength( ) ) = = sti2) 
if(srl == su2) 
| 
//MessageBox( str2 ) ; 
number = FucSet. m ID; // 储 存 符合 条 件 的 每 条 记录 的 了 用 号 
Recordcount + + ; // 查 找到 的 符合 条 件 的 记录 数 ,每 查找 到 一 条 值 自动 加 一 
FucSet. MoveLast( ) ; 
| 
// | 


FucSet. MoveNext( ) ; 
| 
if( Recordcount = =0) 


| 
Dsl. Answer = "我 没 听 清楚 你 说 的 ,请 再 说 一 遍 !" ; 
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Dsl. Act = "0000"; 
//MessageBox ( " J£ 15 Wr Ti 28 JR UJ" ) ; 


else 


srand( ( unsigned) time(. NULL ) ) ; // 


CString ch; 
ch. Format ( " 96 d" , number) ; // 把 整数 转换 为 Cstring 类 型 


FucSet m  strFilter 2 "ID = " «ch; /查找 表 中 ID 等 于 ch 的 记录 ,实现 在 所 有 符合 
条 件 的 记录 中 随机 调 出 一 条 的 功能 

FucSet. Requery( ) ; 

Ds1. Answer = FucSet. m _ Answer; 


Dsl. Act = FucSet. m _ Action; 
// MessageBox ( Dsl. Act) ; 


FucSet. Close( ) ; 
| 


return Dsl; 


| 
/ // kk tke tee sse e E À TERR G e Fore PAR [RB — e e eee eet 


5.3.2 语音 数据 库 的 设计 


在 语音 数据 库 中 ， 首 先 要 编写 许多 具有 跟 情 感 相 关联 的 语句 ， 通 过 这 些 语句 的 输入 ， 即 
作为 外 界 刺 激 信号 ， 使 得 程序 在 数据 库 中 直接 匹配 该 语句 的 情感 状态 。 


K 5-3 所 示 为 语音 数据 库 简 单 示 例 。 
A53 语音 数据 库 设 计 表 
i^] 对 应 的 情感 状态 对 应 的 字符 串 
今天 天 气 真 好 悦 01 
你 好 像 没 电 了 DE: 02 
你 真 聪明 喜悦 01 
你 怕 关 电源 吗 恐惧 03 
天 是 蓝 色 的 平静 00 
你 真 漂亮 喜悦 01 


$1 


( 续 ) 

语 ^g 对 应 的 情感 状态 对 应 的 字符 串 
你 怕 摔 吗 SL 03 
你 是 大 明星 喜悦 01 
我 不 认识 你 Tots 02 
老虎 来 了 MR 03 
你 跳舞 真 好 喜悦 01 
领导 来 看 演出 了 喜悦 01 
MK EET Tots 02 
地 球 是 圆 的 平静 00 
你 该 退休 了 MR 03 


这 里 面 的 对 应 字符 串 包 含 着 情感 信息 ， 在 程序 中 用 m response 来 存储 ， 而 这 里 面 对 应 
的 多 智能 体 控制 来 说 ， 还 需要 有 m idnum 来 存储 机 器 人 的 ID 号 ， 以 确保 这 个 命令 是 发 给 
具体 的 某 个 机 器 人 的 。 
在 实验 中 ,运用 机 器 人 的 个 数 决 定 了 存储 机 器 人 ID 号 的 变量 个 数 ， 以 两 个 机 器 人 为 例 ， 
分 别 对 应 ID 号 “01”“02”， 那 么 在 对 应 的 字符 串 中 就 应 该 添加 上 ID 号 的 信息 。 
语音 数据 库 的 字符 串 的 结构 见 表 5-4。 
X54 语音 数据 库 字 符 串 结构 表 


第 一 个 机 器 人 了 JD 号 第 二 个 机 器 人 了 症 号 外 界 刺激 信号 反映 的 情感 


01 02 01 


上 述 表示 一 号 机 器 人 与 二 号 机 器 人 在 外 界 刺激 信号 作用 下 ， 所 确定 的 喜悦 的 情感 状态 。 

如 何 处 理 这 个 数据 库 转 过 来 的 字符 串 尤 为 重要 ， 它 是 这 就 预示 着 整个 实验 的 成 败 。 将 字 
符 串 “010201” 进 行 处 理 ， 然 后 再 将 变量 赋值 。 程 序 编写 过 程 如 下 : 
//11111111111111111111111111111///wangtianzeng/////s 读 取 文件 发 送 动作 数据 并 运 
t Io EE 
void CRobotSoftDlg : : ReadFromFileAndRun( CString str) 
| 

int iStrlengh; 

iStrlengh = str. GetLength( ) ; 

if(iStlengh ! = 6) // 数 据 库 返 回 的 字符 串 长 度 为 6 

| 

MessageBox(" 文 件 格 式 不 正确 ,请 检查 数据 库 中 的 动作 文件 格式 !" ) ; 


return ; 


CString strl ,str2 , str3 


strl = str. Left(2) ;// 取 第 一 个 机 器 人 的 ID 号 
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str2 = str. Mid (2,2) ;// 取 第 二 个 机 器 人 的 ID 号 
str3 = str. Right(2) ;// 取 情感 状态 


m _idnum1 = (unsigned char) testoul(strl , 0, 16) ;// 将 字符 串 型 转化 成 整形 
m idnum2 = ( unsigned char) tcstoul(su2, 0, 16) ; 
m response = (unsigned char) testoul(str3, 0, 16) ; 
DoActionl(1,m  idnuml, m response) ;// 执 行 第 一 个 机 器 人 的 动作 命 4 
DoAction2(1,m  idnum2, m response) ;// 执 行 第 二 个 机 器 人 的 动作 命 4 


4» o4 


| 


//11111111111111111111111111111////wangtianzeng//// e 读 取 文件 发 送 动作 数据 并 运 
FVIII 


5.4 双 足 步行 机 器 人 动作 的 设计 


5.4.1 基于 情感 方面 的 动作 设计 


双 足 机 器 人 的 情感 由 上 一 节 摘 述 应 该 分 为 大 致 平静 、 襄 悦 、 慎 奶 、 疏 惧 四 种 状态 ， 那 么 
在 这 四 个 状态 中 应 该 分 别 对 应 有 能 够 表达 其 情感 状态 的 机 器 人 的 动作 。 

由 于 我 们 试验 平台 的 双 足 机 器 人 不 同 于 具有 表情 的 大 型 拟人 机 器 人 ， 因 此 表达 其 情感 的 
途径 束 只 有 它 的 动作 。 动 作 的 设计 要 符合 人 的 正常 行为 规范 ， 如 果 动 作 设 计 得 太 厅 张 就 失去 
了 “类 人 ”的 意义 ， 换 句 话 说， 让 双 足 机 器 人 做 出 人 无 法 做 到 的 动作 是 没有 意义 的 ; 如 果 
动作 设计 得 太 “ 温 和 ”， 即 幅度 小 ， 这 样 虽然 具有 模仿 人 动作 的 作用 ， 但 无 法 清晰 地 表达 双 
足 机 器 人 的 情感 ， 这 样 的 动作 在 本 书 中 不 予 采 纳 ， 但 可 以 在 其 他 方面 运用 ， 例 如 招手 、 伸 展 
运动 等 。 

那么 情感 一 一 动作 关系 表 就 应 该 见 表 5-5。 

表 5-5 情感 


动作 关系 表 
情感 状态 双 足 机 器 人 的 动作 设计 
平静 直立 
踏 脚 跳 
TUS BERE 
喜悦 单 腿 支撑 跳舞 
倒立 跳 街舞 
鞠 身 
打 拳 
跑腿 
[0/15 
DEAE 
扩 胸 运动 


zx 
E 


情感 状态 双 足 机 器 人 的 动作 设计 
TE 


手 遮 脸 


足下 抱 头 


平静 状态 下 的 动作 如 图 5-16 所 示 ， 喜 悦 状态 下 的 动作 如 图 5-17 所 示 。 


到 5-16 平静 状态 下 的 动作 图 $-17 喜悦 状态 下 的 动作 


5. 4.2 ”基于 性 格 方面 的 动作 设计 


对 于 个 性 空间 ， 通 过 设置 不 同 的 情绪 恼 ， 来 设置 机 器 人 对 于 情感 状态 转移 的 难 易 度 ， 这 
从 外 表 看 来 就 如 同人 一 样 ， 对 于 情感 状态 转移 比较 容易 的 机 器 人 ， 它 很 容易 受到 外 界 刺激 的 
影响 ， 表 现 很 活泼 ， 如 同性 格外 向 的 人 一 样 ， 反 之 就 是 内 向 性 格 。 

通过 动作 的 频率 快慢 也 可 以 体现 机 器 人 的 性 格 特点 ， 动 作 频 率 快 往往 能 表现 机 器 人 的 外 
向 特点 ， 这 在 起 初 的 对 于 具体 的 机 器 人 的 动作 设计 时 就 可 以 设置 ， 这 里 有 具体 负责 动作 速度 
的 设置 ， 如 图 5-18 所 示 。 

o n er 适合 性 格外 向 机 器 人 的 动 
作 设 计 ， 而 速度 1 为 最 小 ， 适 合 性 格 内 向 机 器 人 的 动作 设计 。 由 此 通过 舵 机 转动 组 成 动作 元 
2 0 054025 e 
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"S ROBCON 


文件 REAA 设置 帮助 
速度 控制 组 号 重复 ID 


R se-95:0 $:»:9:| NB am rm 


图 $-18 ”上 位 机 中 动作 速度 的 设置 图 


复杂 动作 


基本 动作 


舵 机 转动 度数 


舵 机 转动 度数 


动作 元 素 


舵 机 转动 度数 


图 5-19 ”机 器 人 行为 结构 图 


5.5 小 结 


本 章 结合 第 2 章 所 介绍 的 机 器 人 控制 的 相关 理论 与 技术 ， 着 重地 对 双 足 机 器 人 的 情感 建 
模 与 行为 实现 进行 设计 和 完成 。 在 VC + + 开发 环境 和 已 有 的 无 线 通信 模块 的 基础 ， 对 多 智 
能 体 控制 中 的 动作 协调 设计 、 动 作 转 化 程序 以 及 对 复杂 的 “ 千 手 观音 ”机 器 人 动作 表演 进 
行 分 析 和 介绍 。 为 了 使 双 足 机 器 人 具有 一 定 的 情感 与 情绪 ， 通 过 隐 马 尔 可 夫 模 型 的 建立 ， 完 
成 了 对 双 足 机 器 人 情感 建 模 以 及 行为 决策 的 设计 ， 实 现 了 情感 转移 控制 。 同 时 介绍 了 情绪 炉 
的 概念 ， 使 得 机 器 人 具有 一 定 的 个 性 化 ， 即 内 向 或 外 向 的 性 格 取向 。 将 传统 的 手动 操作 机 器 
人 界面 发 展 成 为 语音 对 双 足 机 器 人 的 控制 平台 ， 进 而 设计 出 相应 的 语音 数据 库 ， 将 具体 对 话 
内 容 与 情感 状态 进行 有 机 关联 。 对 机 器 人 动作 设计 进行 优化 ， 使 得 动作 在 表达 机 器 人 的 情感 
方面 、 性 格 方面 都 表达 得 更 加 合理 化 ， 以 达到 在 机 器 人 实物 课题 实验 演示 中 ， 取 得 更 好 的 效 
Fo 
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6.1 SIE 


随 着 当今 人 工 智 能 的 发 展 ， 我 们 对 双 足 机 器 人 的 要 求 已 不 仅仅 是 完成 机 械 作 业 和 逻辑 推 
理 ， 简 单 地 模仿 人 的 步 态 行动 ， 以 及 如 何 让 机 器 人 更 加 智能 化 、 赋 有 情感 ， 是 目前 的 研究 趋 
势 之 一 。 双 足 机 器 人 更 高 阶 的 应 用 之 一 就 是 类 人 型 机 器 人 ， 更 易于 适应 人 类 环境 并 为 人 类 所 
应 用 ， 例 如 在 服务 业 和 娱乐 产业 中 ， 它 们 可 以 辨识 更 精准 的 语言 、 表 情 、 手 势 等 信息 并 加 以 
分 析 ， 解 读 出 在 复杂 环境 下 人 类 多 变 的 情感 变化 ， 形 成 更 具备 人 类 形态 的 姿势 动作 。 本 章 将 
着 重 研究 如 何 赋予 双 足 机 器 人 情感 使 其 能 够 在 不 同情 感 状态 下 走出 不 同 的 步 态 。 

肢体 动作 是 情感 的 外 化 ， 将 各 类 情感 寅 于 各 种 不 同 的 步 态 行为 中 ， 可 以 表达 出 更 精确 的 
情感 信息 ， 这 种 表现 方式 直观 且 形 象 。 我 们 在 建立 准确 的 情感 模型 之 前 ， 先 要 归纳 在 不 同 的 
情感 状态 下 相对 应 的 步 态 表 现 。 

人 类 的 情感 状态 除了 平静 以 外 ,一般 有 喜悦 、 翡 伤 、 拒 绝 、 厌 有 恶 、 激 动 、 异 怒 等 。 因 此 
双 足 机 带 人 在 不 同情 感 状 态 下 可 以 拟 设计 为 兴奋 时 双 足 机 带 人 会 双 腿 路 起 ， 显 示 出 一 种 很 开 
心 的 状态 ， 行 走时 速度 会 加 快 ， 览 步 较 小 ; 悲伤 诅 形 时 ， 它 会 步伐 缓慢 迟 湛 ， 路 步 明显 变 
小 ; 当 表 达 拒 绝 或 厌恶 的 情感 时 ， 双 足 向 后 退 ， 并 站 立 ， 身 体 明显 向 后 倾 等 。 

现今 对 情感 化 的 双 足 机 器 人 的 研究 越 来 越 引 起 研究 者 们 的 广泛 关注 ， 在 有 关机 器 人 的 研 
究 里 逐渐 变 为 热门 研究 对 象 ， 其 中 将 机 器 人 赋予 胶体 语言 并 使 其 表达 自身 的 情感 ， 成 为 机 器 
人 研究 领域 的 一 个 新 方向 。 


6.2 ”情感 模型 相关 理论 


D 
D 


现 如 今 ， 对 情感 进行 度量 的 思想 吸引 着 心理 学 、 认 知 科学 和 信息 科学 等 很 多 学 科 的 研究 
人 员 。 由 于 情绪 的 复杂 性 和 对 人 类 本 身 情感 变化 规律 认 知 的 不 完善 性 ， 因 此 虽然 已 有 不 同学 
科 的 研究 者 从 不 同 角 度 试 图 模拟 情绪 的 产生 和 变化 ， 但 这 项 工作 依然 十 分 艰巨 。 而 情感 建 模 
在 功能 的 角度 实现 了 有 限 的 模仿 ， 是 机 顺 情 感化 的 一 大 重要 突破 。 国 内 外 研究 者 针对 情感 的 
相关 有 效 算法 ， 提 出 了 在 一 定 范围 内 的 不 同 模型 用 来 进行 类 似 情感 的 计量 ， 如 知名 的 OCC 
算法 、Kismet 情感 模型 、HMM 情感 模型 、 基 于 欧式 空间 的 人 工 情 感 数 学 模型 等 ， 具 体 如 图 
6-1 所 示 。 

OCC 情感 模型 是 1988 年 Ortony、Clore 和 Collins 在 所 出 版 的 Cognitive Structure of Emo- 
tions 一 书 中 给 出 的 著名 情绪 认 知 模型 。 它 是 第 一 个 以 计算 机 实现 为 目的 而 发 展 起 来 的 模型 。 
它 通过 分 析 环 境 中 所 发 生 的 各 种 事件 ， 以 及 和 其 他 实体 交互 的 行为 可 能 发 生 的 各 种 情感 ， 在 
此 基础 上 以 规则 的 形式 总 结 并 归纳 出 这 些 对 应 关系 。0CC 模型 根据 不 同 的 情感 刺激 提出 22 
种 情感 ， 同 时 对 产生 每 种 情感 的 刺激 特征 进行 了 详细 描述 。 它 是 一 种 基于 情绪 的 认 知 理论 和 
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规则 的 建 模 ， 对 于 情绪 的 激活 和 产生 更 多 考虑 的 是 认识 的 因素 ， 没 有 涉及 情绪 激活 的 其 他 过 


程 。 


基于 马尔 可 夫 链 的 情感 计算 建 模 方法 


基于 自 组 织 理论 的 人 工 心理 建 模 
基于 随机 事件 处 理 的 情感 计算 建 模 方法 
基于 欧式 空间 的 人 工 情感 数学 模型 


基于 贝 叶 斯 网 络 的 情感 模型 


国内 /外 已 有 人 工 情感 数学 模型 


Kismet 情 感 模型 
WE-4R 情 感 模型 


OCC 情 感 模型 


国外 
Salt & Pepper 模 型 


EM 模型 


al 


图 6-1 国内 外 已 有 人 工 情感 数学 模型 


Kismet 情感 模型 是 作为 环境 、 内 部 刺激 和 行为 动作 的 媒介 ， 通 过 这 个 情感 模型 ， 机 器 人 
对 外 界 输入 的 刺激 和 内 部 需要 进行 综合 判断 ， 从 而 引起 表现 行为 的 各 种 变化 ， 机 器 人 能 够 表 
达 愤 怒 、 高 兴 、 兴 趣 、 惊 铠 及 平静 等 情感 。 此 模型 可 以 分 为 情绪 刺激 、 和 情绪 评价 、 人 情绪 激 
活 、 人 情绪 表达 四 个 部 分 。 外 界 情 感 作用 于 该 情感 模型 时 ， 该 情感 模型 运用 效 价 、 唤 醒 度 及 姿 
态 这样 的 表现 形式 识别 作用 于 它 的 激励 ， 之 后 传递 到 情感 空间 ,来 激活 情感 。Kismet 模型 框 
架 如 图 6-2 所 示 。 
美国 研究 人 员 Ekman 和 Friesen 发 现 ， 人 类 有 6 PIERRA, BR, I, WE, 
Wd. DE. ne 种 情绪 可 以 相互 组 合 ， 并 派生 出 其 余 各 种 各 样 的 复合 情绪 ， 如 忧郁 、 
紧张 、 焦 虑 等 。 此 6 种 情感 在 文化 传 中 的 差异 性 小 ， 其 他 情感 都 能 够 由 这 6 种 基本 情感 构 
成 。 以 这 6 种 情感 作为 基本 情感 ， 每 种 个 性 的 情感 表现 都 能 够 表示 为 一 个 具有 6 维 的 向 量 ， 
在 :时刻 (190). 每 种 情感 所 具有 的 情感 强度 可 以 由 以 下 公式 得 到 : 
E= (Pray adis Barr Lorne E E 
HP, Esas Enden Bagets Eomp Erao Faga 是 情感 状态 在 上 时 刻 的 从 高 兴 到 厌恶 


Hu 


fear,t ? digust, t ) 
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情绪 反应 4 部 分 
情绪 评价 情绪 表达 


情绪 刺激 


外 部 事件 
听觉 


Emotion(t) 


情绪 评价 


图 6-2 Kismet 模型 框架 图 
6.3 ”基于 欧式 空间 的 人 工 情 感 模 型 及 Ekman 情感 理论 


1. 基于 欧式 空间 的 人 工 情感 模型 

如 图 6-3 所 示 的 欧式 情感 空间 ， 是 将 基础 情绪 作为 基 矢 量 ， 基 于 情绪 多 维 量 结构 的 维度 
空间 ， 将 情感 能 量化 的 概率 空间 。 在 此 基础 上 研究 机 器 情感 的 组 成 和 情感 状态 变化 的 数学 描 
述 ， 利 用 基于 欧式 空间 的 情感 建 模 方法 ， 研 究 模 型 参数 与 个 性 心理 之 间 的 关系 。 

欧式 情感 空间 模型 内 离散 的 点 都 是 由 基础 情感 组 成 的 ， 
如 图 6-3 所 示 的 空间 包括 了 3 PARRER, BMEM, HRA 
愤怒 。 而 情感 空间 的 其 他 点 是 上 述 3 种 基础 情感 按 轻 重 程 
度 不 同 以 不 同方 式 组 合 而 成 的 。 例 如 ， 规 定 情 感 状 态 的 每 
一 维 仅 取 0,， 0.5, 13x 3 个 数值 ， 而 喜悦 就 可 以 分 为 喜悦 
(0), #0 (0.5), Bi (1) 三 个 状态 。 于 是 这 样 的 可 列 
举 情感 状态 共有 27 个 状态 点 。 其 中 ， 原 点 (0, 0, 0) 除 
了 代表 平静 外 还 可 以 代表 其 他 未 知 的 情感 状态 。 当 情感 模 
型 中 只 有 这 3 种 基础 情感 状态 时 ， 称 为 完全 情感 空间 ， 此 
时 原点 为 平静 点 ; 当 情 感 模型 中 不 只 有 这 3 种 情感 状态 时 ， 
称 为 不 完全 情感 空间 ， 此 时 原点 有 可 能 是 平静 点 ， 也 有 可 能 是 其 余 没有 包含 在 这 个 情感 模型 
中 的 情感 状态 。 

情感 活动 可 以 看 成 这 个 情感 空间 中 各 状态 转移 的 过 程 ， 即 马尔 科 夫 过 程 。 一 般 来 讲 ， 如 
果 情 感 空间 中 包括 不 止 3 个 基础 状态 ， 还 包括 了 个 情感 状态 ， 每 个 情感 状态 可 以 分 为 m 
个 等 级 ， 即 1 =m" ， 这 便 是 7 维 马尔 科 夫 概率 矩阵 。 


图 6-3 ”欧式 情感 空间 
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2. HMM 情感 模型 

HMM EREA HIT TERRE, TERR BERUTE R SEBUSOR TIR TE JUS RII CDS o 
通过 计算 仿真， 验证 所 提出 模型 可 以 较为 正确 地 模拟 情绪 状态 的 自发 转移 及 在 外 界 刺激 时 转 
移 、 变 化 的 动态 过 程 ， 完 整地 描述 情绪 强度 在 外 界 刺激 、 当 前 心情 状态 和 性 格 3 个 方面 因素 
的 综合 影响 下 的 变化 规律 ， 为 情感 计算 和 机 器 情绪 自动 生成 理论 研究 提供 一 种 田 新 的 方法 。 

由 于 情感 是 信息 的 一 种 ， 因 此 可 以 用 信息 坑 的 方法 来 度量 情感 。 当 情绪 有 n 个 状态 ， 每 
个 状态 分 为 m 个 等 级 时 ， MAT =m 种 情感 状态 。 设 P (=1，2，…，!) 为 第 i 个 情感 
RSRK, RA E 就 可 以 定义 为 


E =- CY, PlogP, (C 为 与 对 数 底 及 单位 选择 有 关 常 数 ) 


如 果 情感 空间 中 每 一 个 情感 状态 出 现 的 概率 均 相同 时 ,那么 P= 上 上 ,ie (1, 2 


m^), ， 此 时 情感 炉 达 到 最 大 值 。 
E aax = — ClogP; = Cnlogm 
,代表 研究 范围 内 生命 体 情感 复 杂 程度 的 最 大 值 ， 也 就 是 说 ，E,, 是 上 界 ， 越 接近 此 
数值 意味 着 感情 REH, 
在 情感 空间 的 m’” 个 情感 状态 中 ， 设 茶 一 个 时 刻 处 于 第 i 个 状态 ,那么 它 到 其 他 状态 的 
概率 就 构成 了 一 个 情绪 的 概率 矢量 


€; = (Pa Post Pad Pa); = m", Èp = l,i s 61:2 e d) 
je 
VESTES ARIDE CJ 


ei. C $, pjlogp; 
j=l 
A HOTE £5 ; 
pi 一 一 第 ;种 情感 状态 到 第 7 种 情感 状态 的 概率 。 


6.4 双 足 机 器 人 步 态 情感 模型 的 建立 


aus A HMM 情感 模型 与 Baum-Welch 算法 ， 应 用 于 双 足 机 器 人 步 态 的 情感 模型 建立 。 
. 情感 PPM 
noe dn 即 输入 端 和 输出 端 ， 具 体 如 图 6-4 所 示 。 输 入 端 是 
通过 情感 模型 空间 对 外 界 刺激 进行 反应 ， 输 出 端 是 机 器 人 通过 情感 认 知 系统 进行 步 态 姿势 输 
出 。 整 体 构成 了 机 器 人 情感 接收 和 反应 的 过 程 ， 包 括 情 感 因 子 的 提取 和 分 析 。 除 此 之 外 还 有 
外 界 情 感 刺激 ， 情 感 模 型 与 步 态 姿势 的 对 应 等 。 
2. 基于 HMM 的 情感 建 模 
我 们 首先 要 确定 情感 的 每 个 层次 上 的 种 类 数量 ， 即 HMM 中 对 应 的 状态 数 n 和 心情 种 类 
应 的 个 数 m。 在 每 种 心情 中 ， 各 种 状态 以 一 定 概 率 出 现 。HMM 由 两 部 分 组 成 ， 一 个 为 马 
SENA 由 7 和 A 和 描述 (7 为 初始 状态 概率 矢量 ，A 为 状态 概率 转移 矩阵 ) ， 它 们 决定 了 
马尔 可 夫 链 的 形状 。 其 中 ,马尔 可 夫 链 为 状态 遍历 类 型 ， 严 格 来 说 ,遍历 模型 的 性 质 是 任何 


式 中 
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输出 端 
情感 认 知 系统 


情感 因子 提取 和 分 析 


外 界 刺激 
情感 因子 提取 和 分 析 


一 一 一 一 一 一 一 一 一 一 一 一 一 一 一 十 


情感 模型 


l 
| 
双 足 运动 系统 
l 
l 
1 


一 个 状态 可 由 任 一 个 其 他 状态 在 有 限 步 内 到 达 。 此 类 模型 性 质 为 每 个 a 系数 都 是 正 的 ， 即 
对 任意 i, j, A w >0。HMM 另 一 组 成 部 分 由 B 描述 ，B 为 观察 概率 和 矩阵， 产生 的 输出 为 观 
察 值 序列 。HMM 的 组 成 如 图 6-5 所 示 。 


马尔 可 夫 链 qi d» -> d 随机 过 程 O, O, ENS O. 
(x, A) 状态 序列 (B) 观察 值 序列 


图 6-5 HMM 组 成 示意 图 


ERRAR ART er RIA. 的 选取 也 会 产生 影响 ， 对 于 某 个 人 而 言 ， 在 外 界 刺 激 变化 跨 
度 不 大 时 ， 其 对 应 某 一 心理 状态 的 情绪 炉 数 值 应 基本 相等 ， 所 以 我 们 假定 在 3 种 情感 状态 
(平静 、 开 心 、 难 过 ) 时 ， 给 出 矩阵 4, MA, (Ak 为 开心 时 的 状态 概率 转移 矩阵 ，A，, 为 难 
过 时 的 状态 概率 转移 矩阵 ) 。 建 立 矩 阵 时 要 考虑 3 点 约束 : 

1) 符合 人 类 情感 规律 ; 


2) 符合 HMM 中 马尔 可 夫 链 的 约束 条 件 ， 对 任意 激励 均 有 B aw = 1; 
3) 要 使 由 HMM Fai i A Het He He HIE 
我 们 假定 当 双 足 机 器 人 未 受 任何 激励 作用 时 的 初始 概率 矢量 z 为 1，0，0)。 我 们 把 
外 界 刺 激 信号 分 为 导致 开心 结果 的 刺激 和 导致 难过 结果 的 刺激 两 种 。 这 样 针对 每 种 刺激 分 别 
有 一 个 状态 转移 概率 矩阵 (Ar WA) 及 可 见 符号 概率 矩阵 (B, 和 B,) 与 之 对 应 。 用 于 模 
型 重 估 的 状态 转移 概率 矩阵 及 可 见 符号 概率 矩阵 初始 值 的 选取 ， 可 以 由 经 验 来 决定 ， 同 时 考 
ERRIRIK ANOA F NRE 
在 接收 到 开心 的 刺激 时 ， 状 态 转 移 概率 矩阵 为 
0.29 0.7 0.01 
zm 0.9 器 


0.4 0.5 0.1 


03 0.6 01 
B,-/0.149 0.85 0.001 

0.651 0.2 0.149 

在 接收 到 难过 的 刺激 时 ， 状 态 转移 概率 矩阵 为 

0.29 0.01 0.7 

A,2|04 01 0.5 

0.09 0.01 0.9 

03 01 05 

B,-|0.651 0.149 0.2 

0.149 0.01 0.85 
- 


赋予 模型 初 值 Or， 
Arp, Bre 


调用 以 x= (1,0,0) 为 初始 状 
态 概率 的 Baum-Welch 算 法 计算 


按照 重 估 结 果 4 计 算 下 一 个 可 
能 出 现 的 情感 表现 概率 


把 下 一 个 可 能 出 现 的 情 


以 Vlast 为 基准 ， 调 用 以 
Xx(i)=laststate(i) 为 初始 状 
态 概率 的 Baum-Welch 算 法 计算 


感 表现 按 概率 大 小 排序 


配合 随机 函数 以 计算 出 的 概率 的 
形式 输出 情感 表现 


Vise Vo, Vias= Vi, 
nyy-0 Mrih] 


图 6-6 基于 Baum-Welch 算法 的 程序 系统 
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为 了 得 到 充足 数据 对 所 有 参数 进行 可 靠 估 计 ， 可 以 采用 多 重 观察 序列 ， 即 在 实验 中 多 次 
激励 双 足 机 器 人 ， 记 录 在 不 同 激励 下 得 到 的 双 是 机 器 人 步 态 表现 ， 用 特定 值 来 表示 特定 结 
果 。 观 察 序列 用 二 维 数组 。(1， 间 表示 ,1 代表 第 /个 观察 序列 ，i 代表 观察 时 刻 。 此 步 又 
用 来 调整 初始 参数 ， 得 到 给 定 模 型 的 观察 序列 概率 最 大 的 初始 模型 参数 A= (A, B, m. 

3. 建立 结合 Baum-Welch 算法 的 程序 系统 

利用 Baum-Welch 算法 计算 情感 模型 参数 的 过 程 为 ， 给 出 一 组 训练 数据 ， 经 过 算法 程序 
的 运算 ， 可 以 得 到 使 给 定 观 察 序 列 出 现 概率 局 部 最 大 的 模型 参数 估计 结果 ， 从 而 为 情感 模型 
参数 的 确定 提供 一 种 理论 分 析 方 法 。 根 据 刚才 提供 的 初始 值 和 实验 中 的 观察 序列 训练 模型 ， 
由 最 后 的 模型 产生 观察 序列 并 且 综合 考虑 行为 模式 因素 和 输入 信号 判断 因素 的 影响 ， 得 到 如 
图 6-6 所 示 流 程 图 。 


6.5 基于 情感 的 双 足 运动 系统 


本 节 将 以 日 本 早稻 田 大 学 仿 人 机 器 人 研究 所 研发 的 机 器 人 WABIAN-RII 为 例 ， 描 述 基于 
情感 的 双 足 机 器 人 运动 系统 。 在 本 节 中 ， 考 
虑 3 种 基本 情感 ， 即 平静 、 快 乐 和 难过 。 这 
些 情绪 通过 双 足 机 器 人 行走 风格 表示 ， 行 走 
风格 通过 全 身 运动 化 参数 预先 设 定 。 为 了 在 
情绪 表达 期 间 保 持 机 器 人 平衡 ,采用 艇 干 运 
动 辅助 平衡 ， 其 通过 基于 头 部 ， 手 臂 和 上 腿 部 
运动 的 补偿 运动 控制 来 计算 。 

双 足 类 人 形 机 器 人 具有 43 个 机 械 自由 度 
和 4 个 被 动 自由 度 (平移 运动 和 3 个 旋转 运 
动 )。WABIAN-RII 如 图 6-7 所 示 ， 其 高 度 约 
为 1.84m， 总 重量 为 127kg。 

1. 运动 参数 和 行走 模式 

(1) 平静 状态 下 的 行走 模式 ”在 平静 状 
态 下 ， 双 足 机 器 人 采用 平滑 模式 行走 。 腰 、 
头 部 、 脚 可 以 由 多 项 式 决 定 。 平 滑行 走 需 要 
考虑 角度 、 角 速度 、 角 加 速度 和 脚 最 高 位 置 
的 角度 ， 通 过 使 用 6 阶 多 项 式 生 成 地 面 参 数 。 
通过 选择 初始 值 和 最 终 值 产生 脚 位 置 和 方向 
的 3 个 约束 

Kio (49) 2X9, Kio (45) 2X5, Xy, (5) 2X, 
式 中 , 4 为 起 始 时 间 ， i 为 中 间 时 间 ， 4 为 
终止 时 间 。 图 6-7 WABIAN-RII 机 器 人 

位 置 和 取向 x 还 有 4 个 约束 ， 即 零 初始 速度 和 加 速度 、 最 终 速度 和 加 速度 

Soal to) =0, Kioo (tt) -0, pato) -0, OUS, -0 
上 述 7 个 约束 可 以 构成 一 个 6 项 多 项 式 
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x, () =a, +4,t tot tast +ast cag aU 
我 们 可 以 清楚 地 得 到 沿 着 路 径 的 速度 及 加 速度 
X,,(0) 2a, +2a,t +34, -4a,U +Sa &6aub 
X0) 224, *6a,t*12a,0 +20ast +30a 
结合 上 述 公 式 可 以 得 到 7 个 系数 (as, cn, au). 的 值 。 然 后 在 6 个 多 项 式 中 我 们 可 以 得 
到 行走 的 路 线 图 。 
(2) 快乐 状态 下 的 行走 模式 ”如 下 表 ， 在 快乐 状态 下 ， 我 们 设 定 8 个 参数 和 4 个 步 态 


步 ds 特 E 

参数 a b c d 
A: 步 长 长 正常 正常 正常 
B: 脚 M 形 M 形 高 正常 
C. 脚趾 向 外 直线 直线 直线 
D: 腰部 FEF 下 移动 正常 正常 正常 
E: 腰部 在 滚动 轴 上 旋转 固定 固定 固定 
F: 躯干 和 头 部 大 幅度 前 后 摇摆 躯干 只 摇摆 躯干 只 摇摆 脖子 固定 
G: 躯干 和 头 部 躯干 侧面 摇晃 只 摇摆 躯干 只 摇摆 脖子 固定 
H: MR 大 幅度 摆 臂 正常 正常 正常 

其 中 双 足 部 分 : 


A; 正常 步伐 的 脚趾 的 中 间 铸 位 置 为 0.075m， 最终 钴 位 置 为 0.15m， 而 步 长 长 的 脚趾 
Hi X MEN 0.10m, 4 X MEEN 0.20m, 

B. IE% JA TE 32: 2 fr Ex f] $8 — ^R dc: — ^ B Ex rb, ADAE B Jon x BEDS Z 方向 的 
0. 002m/s^ , M 形 脚 踏 轨 迹 在 摆动 阶段 的 第 一 个 和 最 后 一 个 阶段 中 ， 利 用 0. 05m/s^ 到 Z 方向 
的 加 速度 确定 。 在 中 心 脚 中 ， 脚 趾 的 了 方向 位 置 是 固定 的 。 在 步 态 阶 段 的 中 期 ， 侧 脚 具有 
-0.20m 的 趾 部 了 方向 位 置 和 -20* 的 侧 倾 定向 。 高 脚 在 摆动 阶段 的 中 期 具有 0. 10m 的 趾 部 
Z 方向 位 置 和 0. 002 m/s? 的 Z 方 向 加 速度 。 

C; 向 外 的 脚 具有 30. 0* 的 脚趾 偏 航 方向 。 

(3) 难过 状态 下 的 行走 模式 ”在 难过 状态 下 ， 我们 设 定 11 个 参数 和 2 个 步 态 特征 ， 如 
下 表 。 


步 态 特 征 
参数 a b 
A: 速度 慢 正常 
B. 头 部 侧 向 倾斜 直立 
C: 脚趾 向 里 直线 
D; D 拖 着 走 正常 
E; CF 从 前 到 后 摇摆 固定 
F: CT 向 前 弯 直立 
G: 躯干 向 侧面 弯曲 直立 
H: IKF 在 滚动 轴 上 旋转 固定 
I 步 长 短 正常 
J: 头 部 Fk 直立 
K: JR 固定 摆动 
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Lose BT: 

: 正常 速度 为 1.28s/ 步 ， 而 慢 速 为 1.92s/ 步 。 

: 头 部 的 初始 侧 倾 角 设置 为 侧 向 倾斜 20°。 

: 脚趾 的 偏 航 角 设置 为 -10°， 脚 向 内 。 

: 制作 拖 忠 着 行走 的 足 部 ， 在 摆动 的 中 间 阶 段 ， 脚 中 在 Z 方向 位 置 为 0. 02m。 除 此 之 
在 正常 膨 中 胸中 在 方向 位 置 为 0. 10m。 

2. 变量 分 析 

为 了 探索 快乐 和 悲伤 情绪 下 的 双 足 行走 ， 进 行 3D 行走 运动 模拟 。 由 模式 生成 器 根据 运 
动 参数 确定 32 个 步行 运动 模式 。 软 件 使 用 Windows 环境 下 的 Borland Builder C + + 和 
OpenGL， 可 以 记录 3D 情感 行走 的 动画 录像 。 然 后 ， 为 了 更 逼真 地 展示 出 双 足 模型 开始 向 前 
直行 并 且 在 最 后 一 步 绕 偏转 轴线 向 左 转 90。*， 播 放 所 记录 约 15s 的 3D 动画 用 于 评估 。 在 这 
项 研究 中 ， 早 稻田 大 学 的 17 位 本 科 生 作为 评价 者 ， 分 为 5 个 级 别 评估 了 每 个 情感 行走 模式 ， 
5 个 级 别 设 为 0 点 (最 低 点 ) ~4 点 〈 最 高 点 ) 。 每 个 快乐 模式 (ER) 及 难过 模式 Ch 
图 ) 的 点 的 总 和 如 图 6-8 所 示 。 


二 


外 


» 


参数 参数 

模式 A B C D E F G H 总 和 模式 A B C DEFGH IJ K 总 和 
1 a a a a a a a a 33 1 a a a a a a a a a a a 3l 
2 b a b b b a b b 6 2 a b b b a a a a b b b 18 
3 a a a a b b c b 22 3 a a a a a a b b b b a 25 
4 a b b a b d a jl 4 a b b b a a b a a b 28 
5 b a a b a c c a 10 5 a b b a a ba b a a a 20 
6 a a b a b c d b 35 6 a a a b a b a b b b b 16 
7 b a a b b d a b 5 7 a b b a a b b a b b a 6 
8 a a b a a d b a 37 8 a a a b a b b a a a b 35 
9 a b b b a a c b 4 9 a a b b b a a a a 24 
10 b b a a b a d a 24 10 a b a a b aa b a b b 26 
ll a b b b b b a a 16 11 a a b b ba b a a b a 3l 
12 b a a a b b b 12 12 a b a a b a b a a 37 
13 b b b a a c a b 24 13 a b a b b b a a b a a 13 
14 a b a b b € b a 12 14 a a b a b b a a a b b 16 
15 b b b a b d b a 45 15 a b a b b b b b a b a 8 
16 a b a b a d d b 5 16 a a b a b b b b ba b 34 
17 [o b a b a c a 37 17 b b a b a a a a 22 
18 a c a b a a d b 4 18 b a ba aaa b aa b 27 
19 b c b a a b a b 25 19 b b a b aab a a a 24 
20 a [o a b b b b a 13 20 b a b a a a b a 24 
21 a c b b b c a a 18 21 b a b b a b a a a 14 
22 b c a a a c b b 29 22 b b aaabalaaab 23 
23 a c b b a d c b 13 23 b a b ba bb b a a a 18 
24 b c a a b d d a 24 24 b b a a a b b b 18 
25 d a b b a a b 6 25 b b b a b a a a a 15 
26 a d b a a a b a 30 26 b a a b baa a aa b 28 
27 b d a b a b c a 9 27 b b ba bab baa a 39 
28 a d b a a b c a 10 28 b a a b b a b 27 
29 a d a a b c c b 36 29 ba a a b ba b b b a 28 
30 b d b b a € d a 9 30 b b bb bba b aa b B 
31 a d a a a d a a 37 31 b a a a b bb a aa a 29 
32 d b b b d b b 2 32 b b b b b b b a b 7 


图 6-8 ”快乐 模式 和 难过 模式 的 评估 点 


为 了 获得 有 效 的 情感 行走 模式 ， 我 们 可 以 分 析 运 动 参数 的 方差 值 。 其 中 ,一 组 nn 个 测量 
(情绪 模式 的 数量 ) 中 的 可 变性 与 SS (偏差 平方 和 ) 成 比例 。 
SS = 所 有 y 值 的 平方 和 -CM 
EXC 2,25 - 


izl J=1 


- SST + SSE 
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RP, y RI y 分 别 表示 i, 7 测量 样本 的 方差 和 样本 的 平均 值 ，CM 和 SST 分 别 表示 平方 值 和 
平方 和 的 校正 ; SSE 表示 误差 的 平方 和 。 式 中 ，7, 是 处 理 值 的 总 数 。 


X 2 
EUM (XX) 


CM 2 i=l j=1 zs —19 
n n "es 
p = u p p- 
SST = YMn(T, - y)! = > —- CM 
i=l i=l n; 
SSE = SS - SST 
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第 7 全 METHA 
技术 的 课程 实验 


双 足 步行 机 如 人 是 一 个 集 多 学 科 于 一 体 的 综合 平台 ， 制 作 双 足 步 行 机 器 人 具有 很 强 的 实 
践 性 ， 只 有 读者 亲自 动手 做 多 学 科 的 相关 实验 ， 才 能 够 更 加 深入 地 掌握 其 相关 的 制作 技术 。 
本 章 通过 PIC 单片机 编程 、 舵 机 控制 、 机 械 结构 设计 与 认识 、 动 作 调 试 、 上 位 机 编程 、ZMP 
实验 、 多 智能 体 协 调控 制 、 语 音 控 制 等 12 个 实验 ,讲授 了 双 足 步行 机 器 人 具体 的 制作 方法 
与 基本 技术 。 


实验 一 ”典型 PIC 单片机 控制 心 片 的 编程 实验 


一 、 实 验 目的 


1) 熟悉 PIC 单片机 和 MPLAB-IDE 编程 环境 。 

2) 了 解 MPLAB ICD2 在 线 调试 器 的 作用 及 安装 ， 熟 悉 连 接 和 配置 MPLAB ICD2 。 
3) 学 会 创建 工程 文件 、 编 写 源 文件 代码 并 对 源 文件 进行 编译 。 

4) 熟悉 使 用 MPLAB ICD2 在 线 调试 器 的 调试 和 下 载 程序 。 


二 、 实 验 设备 
PC 一 台 、MPLAB 安装 软件 、MPLAB ICD2 在 线 调 试 器 、 目 标 电路 板 。 
三 、 实 验 原理 与 说 明 


1. PIC 单片机 简介 

双 足 步行 机 器 人 的 控制 芯片 为 Microchip 公司 生产 的 PIC 系列 16F877A 单片机 ， 所 以 下 
面 主 要 介绍 的 是 PIC 中 档 系 列 单片机 16F877A，16F877A 引 脚 排列 如 图 7-1 所 示 。 

PIC 共有 35 条 指令 ， 每 条 指令 字 长 为 14 位， 其 指令 向 上 兼容 ， 整 个 指令 系统 的 指令 按 
操作 方式 大 体 可 分 成 3 类 : 

1) 字 节 操作 类 指令 。 

2) 位 操作 类 指令 。 

3) 立即 数 操作 和 控制 操作 类 。 

PIC 系列 单片机 是 采用 精简 指令 集 计 算 (RISC) 结构 体系 ， 所 以 寻 址 方式 既 少 又 简 
单 。 寻 址 方式 根据 操作 数 来 源 不 同 ， 可 分 为 立即 数 寻 址 、 寄 存 器 间接 寻 址 、 直 接 寻 址 和 
位 寻 址 4 种 。 每 条 指令 字 长 为 14 位 ， 由 于 篇 幅 有 限 ， 仅 在 表 7-1 中 列 出 了 设计 时 所 用 到 
的 字 节 操作 指令 、 位 操作 指令 和 立即 数 操作 与 控制 操作 指令 。 表 7-2 是 表 7-1 操作 码 字 符 
的 说 明 。 


PDIP 
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MCLE Ve Tuy — Oi ~/ wh = RB7ypGD 
RAO/ANO ——>— [12 39[] ——— RB6/PGC 
RATIANI =—— [13 38L] 一 -一 RB5 
RA2/AN2/VRFF- 一 -~ [4 37[] 一 -一 RB4 
RAS/ANG/Vgpp, ——— 5 36 -—- RB3/PGM 
RA4/TOCKI 一 ~ [16 350 一 ~ RB2 
RAS/ANA/SS 一 > [17 340 ——— RBI 
REO/RD/ANS ——— U8 33[] 一 -一 RBO/INT 
REI/WR/AN6 一 -一口 9 Š 32[] ——— von 
RE2/CS/AN7 —— 口 10 S 3H = vss 
Vpp 一 一 口 1 eo 301] ——— RD7/PSP7 
Vss ——— O12 S 29[] 一 -= RD6/PSP6 
OSCLCLKIN 一 = [113 E 28[] 一 -一 RDS/PSPS 
OSC2/CLKOUT ——— [114 27L] ——— RD4/PSP4 
RCO/TIOSO/TICKI ~ ~ [] 15 260 ——— RCT/RX/DT 
RCLTIOSUVCCP2 ——e [O 16 25L] ——e— RC6/TX/CK 
RC2/CCPl ——e []17 2A[] ——— RC5/SDO 
RC3/SCK/SCL. —— O 18 23L] ——e— RC4/SDI/SDA 
RDOPSP0 ——— O 19 220] —— RD3/PSP3 
RDLPSP1 一 -= []20 210 ——— RDO/PSP2 
图 7-1 PIC16F877A 引 脚 排列 
表 7-1 PIC16F877A 指令 设置 
助 记 符 ， 操 作 数 说 — Hj 指令 周期 影响 的 状态 位 
字 节 操作 类 指令 
ADDWF f, d 将 W 和 f 相 加 1 C, DC, Z 
ANDWF f, d W 和 f “与 ”操作 1 Z 
CLRF f 对 上 清 零 1 Z 
CLRW - 对 W 清 零 1 Z 
DECFSZ f, d f 减 1 操作 ， 若 为 0， 间 跳 1 (2) 
INCF f, d f 加 1 操作 1 Z 
INCFSZ f, d f 加 1 操作 ， 若 为 0， 间 跳 1 (2) 
IORWF f, d W 与 f 同 或 1 Z 
MOVF f, d 传送 f 1 Z 
MOVWF f 将 W 送 至 f 1 
NOP 空 操作 1 
RLF f, d f 寄存 器 带 进位 左 循环 1 C 
RRF f, d f 寄存 器 带 进位 右 循环 1 C 
XORWF f, d W 与 f 异 或 1 Z 
位 操作 类 指令 
BCF f, b 清 f 的 位 b 1 
BSF f, b Eb 1 
BTFSC f，b 测试 f 的 位 b ， 为 0， 间 跳 1 (2) 
BTFSS f, b 测试 f 的 位 b， 为 1， 间 跳 1 (2) 
立即 数 与 控制 操作 类 指令 
ADDLW k 立即 数 加 W 1 C, DC, Z 
ANDLW k 立即 数 与 W 相 与 1 Z 
CALL k 调用 子 程序 2 
GOTO k 跳 转 2 
IORLW k 立即 数 与 W 同 或 1 Z 
MOVLW k 立即 数 移 到 W 1 
RETFIE - 中 断 返 回 2 
RETLW k 立即 数 送 W 子 程序 返回 2 
RETURN - 从 子 程序 返回 2 
XORLW k 立即 数 与 W 相 异 或 1 Z 


注 : Z、DC、C 分 别 为 状态 (Status). 寄存 器 中 的 零 标志 位 、 辅 助 ; 


PEIEE, X 


位 / 借 位 位 。 


表 7-2 操作 码 字符 说 明 


字符 说 Hj 

f 寄存 器 地 址 (0x00 -07F) 

d 表示 目的 寄存 器 选择 。d =0， 结 果 存 于 W 中 ; d4=1， 结 果 存 于 寄存 器 { 中 。 默 认 值 d4=1 

wW 工作 寄存 器 ( 累加 器 ) 

b 某 8 位 寄存 器 f 内 的 位 地 址 

k 立即 数 、 常 量 或 标号 

以 上 都 是 汇编 指令 ,不 易 记 忆 、 不 易 读 、 不 易 移 植 。 双 是 步行 机 器 人 采用 通俗 易 懂 的 C 
语言 来 开发 。 


2. MPLAB-IDE 编程 环境 

MPLAB 集成 开发 环境 (IDE) 是 综合 的 编辑 器 、 项 目 管理 器 和 设计 平台 ,适用 于 使 用 
Microchip 公司 的 PIC 系列 单片机 进行 退 入 式 设计 的 应 用 开发 。 

3. MPLAB ICD2 在 线 调试 器 

ICD2 是 (in-circuit debugger) 的 英文 缩写 ， 中 文 是 “在 线 调 试 ” 的 意思 。 数 字 “2”， 
是 因为 它 是 ICD1 的 改进 版 , 支持 调试 更 多 Flash 存储 器 芯片 。ICD2 的 作用 是 让 用 户 查看 单 
片 机 内 部 的 寄存 器 数据 ， 帮 助 我 们 学 习 及 发 现 程序 问题 。ICD2 本 身 既 是 一 个 调试 器 ， 同 时 
也 是 一 个 烧 入 器 。 因 为 在 线 调试 本 身 就 是 要 求 通过 ICD2 把 目标 代码 下 载 到 芯片 内 部 ， 只 不 
过 调试 时 多 写 了 一 部 分 监控 代码 而 已 。 如 果 不 需 要 进行 在 线 调试 ， 就 可 以 把 ICD2 看 作为 一 
个 编程 工具 ， 把 目标 代码 下 载 后 ， 拔 掉 ICD2 和 目标 板 的 连 线 ， 单片机 就 可 以 独立 运行 了 。 


四 、 实 验 步 又 


1. 安装 PIC 单片机 MPLAB-IDE 编程 环境 及 ICD2 在 线 调试 器 并 创建 工程 

(1) 安装 MPLAB IDE 从 光盘 安装 ， 将 光盘 放 和 驱动 器 内 ， 跟 随 屏幕 上 的 菜单 安装 
MPLAB IDE, 

也 可 浏览 光盘 ， 打 开 “softdown” 文 件 夹 ， 解 压 文件 ， 双 击 其 中 的 “MPLAB v7. 50 
Install. exe” 进 行 安 装 。 

MPLAB IDE 里 没有 自 带 C 编译 器 ， 安 装 完 MPLAB IDE 后 需要 安装 Hi-tech PICC Compil- 
er (参考 安装 说 明 书 安装 即 可 ， 此 软件 需 自行 下 载 或 购买 ) 。 

(2) 安装 MPLAB ICD2 前面， 我们 已 经 安装 完了 MPLAB IDE 编程 环境 ， 一 般 在 安装 
目录 下 ， 有 一 个 安装 MPLAB ICD2 的 操作 指南 ezicd2. htm : C: V Program Files\ MPLAB IDE 
V Utilities \ MPUsbIRU V ezicd2. htm， 打 开 后 按照 它 的 说 明 一 步 一 步 地 安装 即 可 。 如 果 目 录 
下 没有 这 个 文档 ， 则 可 按照 与 MPLAB ICD2 配套 的 安装 说 明 书 进行 安装 即 可 。 

(3) 运行 MPLAB IDE 双击 桌面 上 MPLAB IDE 的 图 标 圈 ， 或 者 选择 Start Programs 
Microchip MPLAB IDE—MPLAB IDE。 屏 幕 上 首先 会 显示 MPLAB IDE 的 商标 图 案 ， 然 后 出 现 
MPLAB IDE 的 主 窗口 ， 如 图 7-2 所 示 。 

(4) 创建 工程 

1) 在 图 7-2 所 示 的 对 话 框 中 ， 选 择 菜单 Project 一 Project Wizard， 单 击 “ 下 一 步 ”按钮 ， 
选择 对 话 框 中 的 PIC16F877A 器 件 ， 在 出 现 的 如 图 7-3 所 示 框 中 ， 单 击 “ 下 一 步 ”按钮 ， 出 
现 图 74 所 示 的 对 话 框 。 
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| EPLAB IDE v7. 50 
File Edit Vier Project Debugger Programmer Tools Configure indor Help 
ETTNELTIETII 

Checksum: 0xgfcf 


Wi Output 


| Buid | Version Control | Findin Files | 


PICIBFOTTA E z dec bank 0 


图 72 MPLAB IDE 的 主 窗口 


Froject Wizard 


Step Üne: 
Select a device 


ki-u -Aw | Hi am | 


图 7-3 TIEM EE EAN 
2) 如 图 74 所 示 的 对 话 框 中 ， 选 择 HI-TECH PICC Toolsuite 语言 工具 ， 单 击 “ 下 一 步 ” 
按钮 ， 出 现 图 7-5 所 示 对 话 框 。 
3) 在 图 7-5 所 示 对 话 框 中 ， 输 入 工程 名 和 工程 所 在 的 路 径 ， 这 里 我 们 设 工程 名 为 first， 
保存 在 D:\ frist 文件 下 ， 单 击 “ 下 一 步 ”按钮 。 出 现 图 7-6 所 示 的 对 话 框 。 
4) 此 时 我 们 还 没有 哪些 已 存在 的 文件 需要 添加 到 工程 中 ， 因 此 直接 点 击 下 一 步 。 
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Eroject Wizard 


Step Two: 
Select a language toolzuite 


Active T aolsuite: HI-TECH FICC Toolsuite 


Toolsuite Contents 


PICC Compiler [picc. exe 
FICC Assembler [picc.exe] 


FICC Linker (picc.ese] 


Location 


DAHT-PICSbin*picc. exe Browse... 
Help! My Suite Isn't Listed! | C] Show all installed toolsuites 


Err >] | 取消 | | M | 


图 74 工程 向 导 选 择 语言 工具 
Prugect Wizard 


Step Three: 


Name your project 


Project M ame 
[first 


Froject Directory 
|D:Virst 


&.E—cHE(G)| F D > 取消 帮助 


图 7-5 工程 名 和 工程 路 径 设 置 
5) 单 击 完成 ， 项 目 工程 建立 完成 。 
2. 编译 程序 
1) 单 击 Pile 一 New 新 建 一 个 文件 ， 编 写 程序 代码 ， 如 下 : 
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Step Four: B 

Add any existing files to your project "e 
+ C: ^ 
Ze D: — Add» 

*-[7] Administratorit pF 

+ Downloads EREMO 

*- [7] first 

+ KuGoo 

*- [7] Program Files 

=» Qa 表 情 全 集 J 

+- seed 

+ winRAR 

* C) 安装 

+- 补丁 1 m Check the bos to copy the file to the 
< > project directory 

< 上 一 步 @) | 下 一 步 中 >| mus — | 帮助 


图 7-6， 添 加 已 存在 的 文件 到 工程 中 
Hinclude < pic. h > //PICI6F877 的 头 文件 


void main( void ) 


unsigned int i =0; 
for (1;1 «105i * +) 
printf( " This is my first PIC program" ) ; 
while(1) ; 
| 
2) 单 击 Pile 一 Save 保存 这 个 文件 到 DD; \ frist 文件 下 ， 文 件 名 为 first. co 
3) 添加 first. c 到 工程 中 去 。 


用 右键 单 击 Source files ， 选 择 “Add Files”， 找 到 first. ec， 上 点击“ 打开 ” 即 可 ， 具 体操 
作 如 图 727、 图 7-8 所 示 。 


W first — EPLAB IDE v7.50 


[File Edit View Project Debugger Programmer Iocls 


Dé m-m[SAwT| 


| Checksum: 0x0fcf | [Release viri gy E] Eb ^ |) E 


Wl first. acw , B D:Xfirstifirst.c 


Configure Window Kelp 


^ finclude -pic.h- 
void mainivoid) 


//PIClér877E]3l Xp fb | 


Iz! C3 first. mcp 


+- secure i 


On ji] haa rines | m wasigned int i-0; 
f ER for (i;icl0;iei) 
pa Object Filter printfi"This is my first PIC program"); 


+C Library Files 


vhileil; 
-E Other Files 


5] Files i Pg Symbols | 


图 7-7 添加 刚 编 译 好 的 文件 到 工程 中 
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first 一 EPLAB IDE v1.50 


stifirst.c 
Winclude -pic.h- /YPIC16F877 的 头 文件 
void mainivoid) 


日 E] first.mcp 
加 Source Files 
~ L3 Header Files 
- C Object Fies 
$ £3 Library Files 

— Cd Other Files 


i 
unsigned int i-0- 
for ii;i<l0;i++) 

printfií"Ihis is my first PIC progran"); 
whileil: 


Add Files to Project 


SRAD: O first 


Emme 


[3 Fies [êg Symbols 


THEW: first | +F O 


TAM T): All Source Files (+. as:*.c;* h) 


(S) Auto — Let MPLAB IDE guess 
O User -~ File(s) were created especially for this project, use relative path 
C System — Files) are extemal to project, use absolute path 


图 7-8 完成 添加 


4) 保存 工程 ， 单 击 Pile 一 Save Workspace。 
5) 单 击 Project Build All; Æ Output 窗口 中 可 以 看 到 编译 结果 ， 


| first — NPLAB IDE v7.50 


File Edit View Project Debugger Programmer Tools Configure Window Help 
| DG L|r:mm! Sw 


| Checksum: 0x443b | [Release vri c$ E] Eh ^ B al 


Build Version Control | Find in Files 
fWarninglüD0] D:\first\first.c 6 : function dea Pi*' 
Executing: "C:AHT-PICXbinXpice. exe" -E"first. — 


//PICléFe 778] 3E f 


Memory Usage Map: fi"This is my first PIC progran"); 


Program ROM $0000 - $003A $0035 
Program ROM — $057C - $0TFF $0284 
$02BF 


$0020 - $0031 $0012 


$0070 - $0076 $0007 
$0018 


J| Program statistics: 


| Total ROM used T03 words (8.6) 
| Total RAM used 25 bytes 【6. 8%) 


Loaded D:\first\first. cof. 
(BUILD SUCCEEDED: Sun May 13 11:10:23 2007 


到 


图 7-9 通过 Output 查看 编译 结果 


假如 文件 汇编 失败 ， 检 查 下 列 两 项 ， 然 后 重新 编译 项 目 : 


中 检查 编辑 器 窗口 中 所 输入 代码 的 拼写 和 格式 。 如 果 汇 编 吉 在 输出 窗口 中 报告 
在 该 错误 信息 上 双击 鼠标 ，MAPLAB 会 打开 源 代码 窗口 ， 并 且 在 源 代码 窗口 的 左边 


如 图 7-9 所 示 。 


Hb 下 


误 
A 


m 
处 显 
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示 绿 色 箭 头 标志 。 

DRAETH PICmicro 器 件 使 用 了 正确 的 汇编 器 。 选 择 Project—Set Language Tool Loca- 
tions， 然 后 检查 显示 出 的 文件 路 径 。 如 果 路 径 正 确 ， 单 击 “Cancel” 按 钮 ， 如 果 路 径 错误 ， 
则 更 改 路 径 ， 然 后 单 击 OK 按钮 ， 如 图 7-10 所 示 。 


Select Language Toolsuite 


Active Toolsuite: HI-TECH FICC Taolsuite 


Toolsuite Contents 


PICE Linker (picc.exe] 


Location 
CAHT-PICSBINSPIEC. EXE 


E 


7-10 设置 语言 工 


6) 单 击 View 一 Program Memory 可 以 观察 程序 存储 器 ， 如 图 7-11 所 示 。 


| first — NPLAB IDE v7.50 


File Edit View Project Debugger Programmer Tools Configure Window Help 


Da a 8M. 
Checksum: 0x443b Release * [i E [5 SB og | 


IAE 


Build ^ Version Control | Find in Files 77BIC167837 的 头 文件 
| arning Ld00] D:VfirstXfirst.c & : function de 4 PiU 


Executing: "C:AHT-PICAbinipicc.exe" -E' first. 


li |Memory Usage Map: 


Wü Program Nemory 


H |Program RO Disassembly 
CLRF 0x3 


HOVWF Oxa 
GOTO üx4 
CLRF 0x3 
Dans izDà BCF Oxa, 0x4 
BCF Oxa, 0x3 


d ||Program st| OnpcedeHex| Machine Symbolic 


Total ROM used T03 words (8. 6%) 
Total RAM used 25 bytes (6.8%) 


Loaded D:\first\first. cof. 
BUILD SUCCEEDED: Sun May 13 11:10:23 2007 


* 


+ * 


7-11 程序 存储 器 


人 说 


3. 连接 MPLAB ICD2 

1) 将 ICD2 通过 电缆 连接 到 计算 机 上 。 

2) 用 独立 充电 电池 给 目标 演示 板 供电 (为 单 向 接 插件 ) 。 

3) 将 ICD2 连接 到 目标 演示 板 上 ( 排 线 中 的 蓝 色 线 靠近 目标 板 电源 ) 。 
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4) 选中 MPALAB IDE 的 DebuggerSelect Tool—MPLAB ICD2， 如 图 7-12 所 示 。 


|« first — EPLAB IDE v7.50 


File Edit View Project J Programmer Tools Configure Window Help 


Dg 


Clear Memory 上 n MPLAB ICD 2 


Checksum: 0x443b | Release * fi 
H Output Df 


3 MPLAB SIM 
4 MPLAB ICE 2000 


[ox usata ford Build | Version C Control | Find in Files A1PIC16F87? 的 涉 交 忻 
| Warning|000] D:\first\firs| 
"HELM s : 1 
Executing: "C:iXHT-PICYAbin* á 1 int i-0; 
for í(i;i-l0;iti) 
Memory Usage Map: printf("This is ny first PIC progran"); 
while ilj); 
Program ROM $0000 - $003 ) 
Program ROM — $057C - $0TF 
Bank O RAM $0020 - $003 
Bank 0 RAM $0070 - $007 
d||Program statistics: 
Total ROM used T03 wal 
Total RAM used 25 b 
vi 
Loaded D:Xfirst&first.cof.| * E 
BUILD SUCCEEDED: Sun May 1 IU: UU 
图 7-12 RAT 


5) 进入 MPLAB ICD2 Setup Wizard 一 步 一 步 设 置 ， 如 图 7-13 所 示 。 


|^ NPLAB IDE v6.62 


File Edit View Project D 司 Programmer Configure Window Help 


Select Tool 
Clear Memory 


"| dE Sa os»uo B W% e | 


Run T9 
5 first.mcep Animate 
I=) Source Files 
Step Into FT 
Step Over Fe 
Euild 
Connect: Reset d 
... Connc 
B inis... r2 
Setting Ireskooiote 
ICDWarnl bcted-Üx4D, read=0x0) 
GE MPLAB ICD 2 Setup Wizard... 
Running 
...Passi Program 


MPLAB I( Bead 


Connect 
Download ICD2 Operating System 


Settings 


图 7-13 ”选择 ICD2 设置 向 导 


: 选择 ICD2 的 USB 连接 模式 ， 如 图 7-14 所 示 。 
: 选择 ICD2 的 供电 方式 ， 如 图 7-15 Bron s 
步骤 三 : 使 能 ICD2 和 IDE 自动 连接 ， 如 图 7-16 所 示 。 
步骤 四 : 使 能 ICD2 自动 下 载 所 需 的 操作 系统 ， 如 图 7-17 所 示 。 
步骤 五 : 单 击 “完成 ”按钮 ， 完 成 向 导 设置 ， 如 图 7-18 所 示 。 
6) 单 击 完成 后 ， 点 击 Debugger Connect, 
所 示 。 


进行 ICD2 与 日 标 板 的 通信 连接， 如 图 7-19 
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FE nT LD Tr 7T rn 


AA, 
g un ICD 2 Setup Wizard [x] 


| 
| 


Comauni cations 


Select a commmications method. 


Com Port Baud Rate 
USB v 0 


xdD, read-ÜüxT1) 


(E—9ejfr-sm»( me ] [ € ) 


图 7-14 选择 ICD2 的 USB 连接 模式 


Omran TRI —c en 


B IPLAR ICD 2 Setup Wizard 


Step Two: 
Select target power source. 


Note: IF you wish to power your application from the MPLAB ICD 2, then the MPLAB ICD 2 s my first PIC program"): 
must be powered with an independent power supply. [MPLAB ICD 2 can not draw enough 
power from the USB cable to program the target. ] 


See the MPLAB ICD 2 Users Manual for more details 


< EE jT- > 取消 帮助 


图 7-15 设置 ICD2 的 供电 方式 


HM. mro nr —e en 
| EPLAB ICD 2 Setup Wizard 


Step Three: 
Enable autc-connection 


Would you like MPLAB IDE to automatically connect to the MPLAB ICD 2 on start up? 
If enabled, MPLAB IDE conveniently connects to the MPLAB ICD 2 at project startup. 


If disabled, MPLAB IDE waits until Ihe user initiates a connect operation before attempting 
to communicate with Ihe MPLAB ICD 2. 


Mote. The potential Hoana lo aoa Eo connection is that Eis IDE "d always 

attempt to communicate with the on project startup. |f there is a device j "i. 
other than the MPLAB ICD 2 on the selected communications channel it might be s my first PIC program"): 
damaged by this attempted communication. 


< 上 一 步 凶 ) 儿 下 一 步 如 > 取消 FR) 


图 7-16 使 能 ICD2 和 IDE 自动 连接 
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7wnran Tor —£ ca 


NPLAH ICD 2 Setup Wizard 


Step Four: 
Enable auto-dewnload of operating systems. 


Would you like MPLAB IDE to automatically download [without prompting) MPLAB ICD 2 
operating systems when needed? 


The MPLAB ICD 2 uses different operating systems for different target families. 


IF enabled, MPLAB ICD 2 will automatically download the appropriate operating system 
whenever it detects that the operating system currently residing within the MPLAB ICD 2 is 
not the corect one for the selected target device, or whenever MPLAB IDE detects a 
newer version of the operating system on the users computer. " 
s my first PIC program"); 
If disabled, MPLAB ICD 2 will prompt the user for permission to download before actually 
downloading. 


MPLAB ICD 2 automatically 


< -E JT—Zz > 职 消 帮助 


图 7-17 使 能 ICD2 自动 下 载 


-nrain Tor —e ca 


M IPLAR ICD 2 Setup Wizard 


Summary 


Click 'Finish' to accept these MPLAB ICD 2 settings 


MPLAB ICD2 Settings 
Com Port: USB 


Power From: MPLAB ICD 2 
AutoConnect: Enabled 
AutoDownlaod: Enabled s my first PIC program"); 


图 7-18  Sép [n] S 


a EPLAB IDE v6.62 


Eile Edit View Project Programmer Configure Window Help 
口 攻 : Select Tool » 
Clear Memory » 
Bun Fa 
i- first. acp Animate 
EÈ Source Files 
first. c 
Header Files Step Into m 
Object Files Step Over ra 
Library Files 
Other Files Rit : 
Breskpoints... FB |:i<10;i++) 


ntf ("This is my first PIC program"): 
MPLAB ICD 2 Setup Wizard... 


Program 
Read 


Er 
Download ICD Operating System 


Settings.. 


| 


连接 调试 


> 


图 7-19 通过 ICD2 3E 
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如 果 出 现 了 图 7-20 所 示 的 信息 ， 说 明 连 接 成 功 ， 可 以 用 来 调试 了 。 


m% EPLAR IDE v6. 52. 


File Edit View Project Debugger Programmer Configure Window Help 


口 医 4 | Checksum: 0x486b | deu Eh ge iD E o D opp o E "05 e| 


= first. mcp 
(2 Source Files 


$include -pic.h- 


Verzion Control Find in i Piles MPLAB ICD 2 


€ 
. Reading ICD Product ID 
Running ICD Self Test 
-.Passed 
MPLAB ICD 2 Ready 
Connecting to MPLAB ICD 2 
. Connected 
Setting Vdd source to MPLAB ICD 2 
ICDWarn0020: 


i Invalid target device expected=0x4D, 


.Reading ICD Product ID 
Running ICD Self Test 
.Passed 
MPLAB ED 2 Ready 
to MPLAB ICD 2 


图 7-20 ERRI 
4. 调试 程序 
1) 设置 芯片 的 配置 字 ， 如 图 7-21 所 示 ， 单 击 Configure 一 Configuration Bits…， 严 格 按照 
图 7-22 进行 配置 。 


A PLAB IDE v6.62 
Eile Edit View Project Debugger Programmer 7 
Dc ] ? Select Device... 


E first. mep 
= Source Files 


Control | Fina i il z|" MPLAB ICD 2 


..Reading ICD Product ID 
Iunning ICD Self Test 
-.Passed 
MPLAB ICD 2 Ready 
Connecting to MPLAB ICD 2 
-.Connected 
Setting Vdd source to MPLAB ICD 2 
ICDWarnO020: Invalid target device id ( 
-.Reading ICD Product ID 
Running ICD Self Test 
-.Passed 
MPLAB ICD 2 Ready 
Connecting to MPLAB ICD 2 
-.Connected 
Setting Vdd source to MPLAB ICD 2 
Target Device PICI6F87T found, revision = bë 
..Reading ICD Product ID 
Running ICD Self Test 
-.Passed 


MPLAB ICD 2 Ready 


图 7-21 WANE TB 


2) 编译 程序 ， 单 击 Project 一 Build Al， 如 图 7-23 所 示 。 

下 载 程序 ， "m Debugger—Program, ， 如 图 7-24 所 示 。 

3) 下 载 完 毕 后 ， 可 以 设置 程序 断 点 ， 观 察 程 序 执行 情况 及 变量 实时 的 值 。 首 先 单 击 
View 一 Watch， 打 开 变 量 监 视 框 ， 如 图 7-25 所 示 。 


gie Checksum: 


0x47 9e 


= first. mcp 
E Source Files 


Category 


Watchdog Timer 

Power Up Timer 
Brown Out Detect 
Low Voltage Program 
Flash Program lrite 
Data EE Read Protect 
Code Protect 


UII 


Off 
Disabled 
Enabled 
Off 

Off 


program"); 


图 7-22 ”芯片 配置 字 配 置 方法 


Bm NPLAH IDE v8.62 
File Edit View Project Debugger Programmer Configure Window Help 
? Checksum: 0x479e 


first. mcp 
i Source Files 


Nl output 


Memory Usage Map: 


Program ROM 
Program ROM 


$0000 
$057C 


words 
words 
words total Program ROM 


Bank 0 RAM 
Bank 0 RAM 


$0020 
$0070 


bytes 
bytes 
bytes total Bank 0 RAM 


Program statistics: 


Total ROM used 
Total RAM used 


703 words (8.63) 
25 bytes (6. 8%) 


Loaded C:XHT-PICYprogMfristifirst.cof 
H Sun Sep 17 17:22:56 2006 


图 7-23 ”编译 成 功 
File m - Configure Window Help : 
|DgEH|mm 


Edit Vier Project Programer Tool: 
Select Tocl 


Clear Henory 


Bun 
i first. acp Animate 
E Source Files ; 
Step Into 
Step Over 
sp Ou B ICD 2| 
[EXUUUU iS Reset p EU iue  CPXBICEICADIUEIIISU AXLIPSC.UUJ 7H OLIISUO. Wap CU TITSU GUL =U Lii 
Menory Breakpoints... F2 
Program . ) words 
Program "PLAB ICD 2 Setup Wizard... | words 
P ) words total Program ROM 
R 
Bank 0 H — 一 -) bytes 
Bank 01 ^ jper ati on ) bytes 
Connect ) bytes total Bank 0 RAM 
Download ICD2 Operating System 
Program Settings... N 


Total ROM used 
Total RAM used 


703 words (8. 6%) 
25 bytes (6.8%) 


Loaded C:\HT-PIC\prog\frist\first. cof 
BUILD SUCCEEDED: Sun Sep 17 17:25:02 2006 


K| 7-24 


调试 模式 下 进行 程序 下 载 
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|« first — NPLAB IDE vT.50 


Programmer Tools Configure Window Help 


Disassembly Listing 2 | 
EEPROM 

File Registers 
Hardware Stack 


fi"This is my first PIC progran"); 


Locals ÜxTFF) 
Program Memory 
Special Function Registers 


1 Memory Usage Gauge 


s.. Debug Executive 
.. Debug Vector 
... Verify Succeeded 
Programming Configuration Bits 
. Config Memory 
Verifying configuration memory... 
1.. Verify Succeeded 
Connecting to debug executive 


Programming succeeded 
13-May-2007, 11:18:47 


MPLAB ICD 2 Ready 


$ 


K 7-25 调 出 查看 窗口 对 变量 进行 监视 


比如 我 们 要 观察 程序 运行 时 变量 i 值 的 情况 ， 单 击 “Watch” 窗 口 的 “Add Symbol” 按 
HH, An 7-26, [EH 7-27 所 示 。 

设置 断 点 、 调 试 ， 可 以 全 速 运行 、 单 步 连续 运行 、 单 步 跨 过 运行 和 复位 四 种 模式 来 调 
试 。 如 图 中 所 示 的 语句 处 设置 断 点 ， 则 可 双击 该 语句 对 应 的 左边 灰色 区 域 ， 则 出 现 断 点 ， 然 
后 再 通过 调试 工具 栏 o Ww 名 多 全国 中 四 种 调试 模式 对 应 的 按钮 进行 断 点 调试 。 以 本 实验 为 
例 ， 设置 好 断 点 后 ,不断 点 击 。 可 以 通过 “Watch” 窗 口 看 到 “i” 值 的 变化 情况 ， 如 图 7- 
28 所 示 。 


| first — EPLAB IDE v1.50 
|File Edit View Froject Debugger Frogrammer Tools Configure Window Help 


BPE &dà v 


DE 


EDS Ae 
put 


| Build | Version Control | Find in Files | MPLAB ICD 2 
MPLAB ICD 2 Ready 
Programming Target... 
.. Validating configuration fields 
..Erasing Part 
..Programming Program Memory (0x0 — OxTFF) 
..Lloading DebugExecutive 
..Programming DebugExecutive 
...Programming Debug Vector 
Verifying... 
...Program Memory 
s.. Debug Executive 
...Debug Vector 
...Verify Succeeded 
Programming Configuration Bits 
. Config Memory 
Verifying configuration memory... 
.-. Verify Succeeded 
Connecting to debug executive 
...Programming succeeded 
|i13-May-2007, 11:18:47 


Watch 1 | watch 2 | Watch 3| Watch 4| 


[d 7-26 ”准备 添加 所 要 查看 的 变量 到 查看 窗口 
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[a first — NPLAB IDE v1.50 
[File Edit View Project Debugger Programmer Tools Configure Window Help 


RA AMA? 


| Checksum: 0x3e3d | Release * ti dx d Eh a 


| Build | Version Control | Find in Files | MPLAB ICD 2 //PICleF8778]3l xc fF 
MPLAB ICD 2 Ready : 
Programming Target... 
.. Validating configuration fields 
..Erasing Part 
..Programming Program Memory (0x0 - ÜxTFF) 
..loading DebugExecutive 
..Programming DebugExecutive 
...Programming Debug Vector 
Verifying... 
^O Program Memory 
... Debug Executive 
...Debug Vector 
| Verify Succeeded 
Programming Configuration Bits 
. Config Memory 
Verifying configuration memory... 
2 Verify Succeeded 
Connecting to debug executive 
...Programming succeeded 
13-May-2007, 11:18:47 


Walch 1 Watch 2 | Watch 3| Watch 4| 


MPLAS ICD 2 Ready 


图 727 已 添加 所 要 查看 的 变量 到 查看 窗口 


irst 一 EPLAB IDE v7.50 


|File Edit View Project Debugger Programmer 
DE|} amosse 
| Checksum; 0x3e3d Release * t1 eue eË Dji oo mo m 


DIDI! ui D: \fir st\first. 


Tools Configure Window Help 


"sm e 


unsigned int i-0; 
for ii;i-l0;iti) 

printfi"This is my first PIC program"); 
whileili; 


MPLAB ICD 2 Ready 
Running Target Add Symbol 
| MPLAB ICD 2 Ready 

Running Target Symbol Name 
MPLAB ICD 2 Ready i Ox0002 
d| Resetting Target 
MPLAB ICD 2 Ready 
Running Target 
MPLAB ICD 2 Ready 
| Running Target 
JELAE ICD 2 Ready 


rr EET 


i Y 


Watch | Watch2| Watch 3 | Watch 4| 


图 7-28” 断 点 调试 并 查看 变量 值 的 变化 


五 、 思 考题 


1. 创建 工程 的 过 程 中 应 注意 哪些 问题 ? 

4. 1) 先 要 检查 MPLAB 软件 是 否 正确 安装 完毕 。 

2) 检查 HT-PIC 软件 是 否 正 确 安装 完毕 。 

3) 在 创建 工程 前 确定 本 工程 采用 汇编 语言 还 是 C 语言 编写 ， 从 而 确定 是 否 选 择 HI- 
TECH PICC Toolsuite Zhi Es o 
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4) 工程 保存 路 径 中 不 要 包含 中 文字 符 。 

2. 安装 和 配置 需要 注意 哪些 问题 ? 

答 : 1) 安装 MPLAB-ICD2 的 驱动 程序 一 定 要 按照 说 明文 件 安 装 ， 以 免 出 现 不 能 连接 等 
异常 情况 。 

2) 仿真 头 的 接线 和 单片机 上 的 接头 要 配合 正确 ， 和 否则 容易 烧 坏 仿真 器 。 

3) 配置 时 要 注意 芯片 的 类 型 和 设置 芯片 的 配置 字 是 和 否 正确 。 

3. 调试 模式 和 编程 模式 的 切换 需要 注意 哪些 事项 ? 

答 : 1) 先 关闭 掉 原 来 的 模式 ， 比 如 当前 是 Debug 模式 ， 先 进 Debugger 一 SelectTools 下 
iX None ， 再 进入 Programer 去 选 。 

2) 切换 后 芯片 的 配置 字 会 发 生 改 变 ， 需 要 重新 配置 ， 否 则 程序 可 能 无 法 正确 运行 。 


实验 二 常用 传感器 实验 


作为 感知 、 采 集 、 转 换 、 传 输 和 处 理 各 种 信息 必 不 可 少 的 功能 器 件 传感器 ， 已 成 为 与 计 
算 机 同等 重要 的 技术 工具 。 本 次 实验 主要 让 同学 们 了 解 超声 波 传感器 、 霍 尔 传感器 、 温 度 传 
感 带 、 红 外 传 感 带 。 


一 、 实 验 目的 


1) 熟悉 机 器 人 技术 中 常见 传感器 的 原理 和 使 用 。 
2) 综合 使 用 PIC 单片机 资源 ， 理 解 中 断定 时 器 的 原理 。 
3) 巩固 C 语言 能 力 ， 掌 握 传 感 器 使 用 的 时 序 关系 。 


二 、 实 验 设备 


PC 一 台 (MPLAB IDE 环境 ) MPLAB ICD2 一 台 、 实 验 板 一 块 〈 集 成 各 种 传感器 ) i 
电 电源 (12V) 、 万 用 表 一 台 、 示 波 器 一 台 及 数 根 毛 插 线 。 

实验 板 载 传感器 : 超声 波 传感器 (接受 探头 、 发 送 探头 ) 、 温 度 传感器 (DSISB20), Æ% 
尔 传感器 、 光 电 传 感 器 。 


三 、 实 验 原理 与 说 明 


1. 霍 尔 传感器 

堆 尔 传感器 有 以 下 几 个 主要 应 用 : 磁场 测量 、 电 流 测量 、 转 速 和 脉冲 测量 、 信 号 的 运算 
和 测量 、 拉 力 和 压力 测量 。 本 次 试验 采用 的 传感器 是 磁场 测量 传感器 。 它 的 最 简单 的 原理 就 
是 当 传感器 连接 到 电路 中 以 后 ， 当 其 处 在 强 磁 场 中 时 它 的 DQ 信号 线 就 会 输出 低 电 平 ， 离 开 
强 磁 场 的 时 候 它 输出 高 电 平 。 但 是 它 对 磁场 的 极 性 是 有 要 求 的 ， 必 须 用 正确 的 极 性 对 准 霍 尔 
传 感 央 ， 它 才能 输出 低 电 平 。 我 们 利用 这 种 特性 可 以 应 用 在 很 多 地 方 ， 比 如 在 机 器 人 的 导轨 
上 适当 地 加 上 几 个 霍 尔 传感器 ， 通 过 这 种 方式 我 们 就 可 以 定位 出 导轨 上 的 机 构 所 在 的 位 置 
了 。 它 的 外 观 及 连 线 如 图 7-29 所 示 。 

2. 光电 传感器 

对 射 式 光 电 传 感 器 包含 在 结构 上 相互 分 离 且 光 轴 相对 放置 的 发 射 器 和 接收 器 ， 发 射 器 发 
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出 的 光线 直接 进入 接收 需 。 当 被 检测 物体 经 过 发 射 器 和 接收 器 之 间 且 阻 断 光 线 时 ， 光 电 传 感 
器 就 产生 了 开关 信和 叶 。 当 检测 物体 是 不 透明 时 ， 对 射 式 光电 传感器 是 最 可 靠 的 检测 模式 。 
这 种 遮挡 式 光 传感器 可 以 应 用 在 很 多 地 方 ， 比 如 电动 机 转速 的 测定 。 安 装 在 门 的 两 侧 可 
以 用 来 防盗 。 
在 对 射 管 没 有 被 不 透明 物体 遮挡 时 ， 发 射 管 发 出 的 光线 能 被 接收 管 接 收 到 ， 这 时 对 射 管 
的 信号 线 输出 低 电 平 ， 当 发 射 管 的 光线 被 不 透明 的 物体 遮挡 住 时 ， 接 收 管 不 能 接受 到 信和 号， 
这 时 对 射 管 输出 高 电 平 。 如 图 7-30 所 示 。 
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[] 7-29 ” 霍 尔 传感器 外 观 及 连 线 图 图 7-30 光电 传感器 发 射 接收 端 有 无 遮挡 示意 图 


3. 温度 传感器 

新 型 数字 温度 传感器 DS18B20 具有 体积 更 小 、 精 度 更 高 、 适 用 电压 更 宽 、 采 用 一 线 总 
线 、 可 组 网 等 优点 ， 在 实际 应 用 中 取得 了 良好 的 测 温 效果 。 

DS18B20 的 主要 特性 ; 

1) 适应 电压 范围 更 宽 ， 电 压 范 围 为 3.0 ~$.5V， 在 寄生 电源 方式 下 可 由 数据 线 供电 。 

2) 独特 的 单线 接口 方式 ，DS18B20 在 与 微 处 理 器 连接 时 仅 需要 一 条 口 线 即 可 实现 微 处 
理 器 与 DS18B20 的 双向 通信 。 

3) DS18B20 支持 多 点 组 网 功能 ， 多 个 DS18B20 可 以 并 联 在 唯一 的 三 线 上 ， 实 现 组 网 多 
点 测 温 。 

4) DS18B20 在 使 用 中 不 需要 任何 外 围 元 件 ， 全 部 传 感 元 件 及 转换 电路 集成 在 形 如 一 只 
晶体 管 的 集成 电路 内 。 

5) 温度 范围 -55 ~ +125% ,在 -10~ +85% 时 精度 为 上 0.5%C 。 

6) 可 编程 的 分 辩 率 为 9 ~ 12 位 ， 对 应 的 可 分 辨 温度 分 别 为 0.5%C、0. 25%C 、0. 125% 和 
0. 0625% ， 可 实现 高 精度 测 温 。 

7) 在 9 位 分 辩 率 时 ， 最 多 在 93.75ms 内 把 温度 转换 为 数字 ，12 位 分 辩 率 时 最 多 在 
75. 0ms 内 把 温度 值 转换 为 数字 ， 速 度 更 快 。 

8) 测量 结果 直接 输出 数字 温度 信号 ， 以 “一 线 总 线 ” 串 行 传送 给 CPU， 同 时 可 传送 
CRC 校 验 码 ， 具 有 极 强 的 抗 干扰 纠 错 能 力 。 

9) 负 压 特性 。 电 源 极 性 接 反 时 ， 芯 片 不 会 因 发 热 而 烧毁 ， 但 不 能 正常 工作 。 它 的 外 形 
及 连 线 如 图 7-31 所 示 。 
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4. 超声 波 传感器 

超声 测 距 是 一 种 非 接触 式 的 检测 方式 。 与 其 他 方法 相 比 ， 如 电磁 的 或 光学 的 方法 ， 它 不 
受 光线 、 被 测 对 象 颜色 等 影响 。 对 于 被 测 物 处 于 黑暗 、 有 灰尘 、 烟 筋 、 电 磁 干 扰 、 有 毒 等 恶 
劣 的 环境 下 有 一 定 的 适应 能 力 。 因 此 在 液 位 测量 、 机 械 手 控制 、 车 辆 自动 导航 、 物 体 识别 等 
方面 有 广泛 应 用 。 特 别 是 应 用 于 空气 中 的 测 距 ， 由 于 空气 中 波 速 较 慢 ， 其 回 波 信号 中 包含 的 
沿 传 播 方 向 上 的 结构 信息 很 容易 检测 出 来 ,具有 很 高 的 分 辨 力 ， 因 而 其 准确 度 也 较 其 他 方法 
为 高 ; 而 且 超 声波 传感器 具有 结构 简单 、 体 积 小 、 信 号 处 理 可 靠 等 特点 。 这 种 技术 常 被 应 用 


于 避 障 技术 中 。 同 学 们 掌握 这 个 传感器 的 使 用 方法 ， 对 学 习 机 器 人 技术 是 非常 有 帮助 的 。 
超声 波 测 距 的 原理 如 图 7-32 所 示 。 
DS18B20 
J 
Vec 
-SC . 
ZO a 
OoO-x 
4.7kQ : 
bd m 
= cc 
图 7-31 温度 传感器 DS18B20 外 观 及 连 线 图 图 7-32 超声波 传 感 需 测 距 原理 网 


发 射 探头 发 射 超声 波 ， 当 超声 波 遇 到 障碍 物 后 声波 被 反射 回来 ， 并 被 接受 探头 接收 到 ， 
控制 单片机 记录 超声 波 从 发 射 到 接受 超声 波 的 时 间 ， 利 用 超声 波 在 空气 中 的 传播 速度 就 可 以 
计算 出 障碍 物 的 距离 . 5S =w/2。 

我 们 使 用 的 超声 波 传感器 是 压 电 式 超 声波 传感器 ZR40- — deed 
16、ZT40-16， 它 们 的 原理 如 图 7-32 所 示 ， 压 电 式 超声 波 发 
生 器 实际 上 是 利用 压 电 晶体 的 谱 振 来 工作 的 。 超 声波 发 生 器 EAD 
内 部 结构 如 图 7-33 所 示 ， 它 有 两 个 压 电 唱片 和 一 个 共振 板 。 0009 
当 它 的 两 极 外 加 脉冲 信号 ， 其 频率 等 于 压 电 晶片 的 固有 振 芒 
频率 时 ， 奈 电 晶片 将 会 发 生 共 振 ， 并 带动 共振 板 振动 ， 便 产 
生 超 声波 。 反 之 ， 如 果 两 电极 间 未 外 加 电压 ， 当 共振 板 接收 er 
到 超声 波 时 ， 将 压迫 压 电 晶片 作 振动 ， 将 机 械 能 转换 为 电信 ie 
号 ， 这 时 它 就 成 为 超声 波 接收 器 了 。 

但 是 接收 到 的 信号 是 非常 微弱 的 ， 所 以 我 们 要 把 它 放 大 ， 以 使 单片机 能 够 检测 到 它 的 大 
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四 、 实 验 步 又 
实验 板 的 布置 如 图 7-34 所 示 。 
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电源 开关 单片机 超声 波 传感器 


温度 传感器 — 霍 尔 传感器 光电 传感器 


图 7-34 ”传感器 实验 板 布置 (正式 ) 图 


1. E RERE 

要 求 : 连接 完整 的 电路 ， 在 单片机 上 下 载 程序 实现 在 奇数 次 中 断 时 〈 霍 尔 传感器 在 奇 
数 次 检测 到 磁场 时 ) 所 有 LED 灯 循 环 点 亮 ， 偶 数 次 中 断 时 〈 霍 尔 传感器 在 偶数 次 检测 到 磁 
场 时 ) 关闭 LED。 

步 又: 

1) 给 试验 板 加 电 (〈 注 : 电源 电压 12V， 电 源 极 性 不 能 接 反 ， 当 电源 部 分 指示 灯 点 亮 时 
表明 试验 板 加 电 正确 ) 。 

2) 用 万 用 表 测 量 霍 尔 传感器 的 信号 线 ， 信 号 线 为 本 端子 中 间 的 插 针 ， 地 线 为 5 端子 
的 上 测 ， 观 察 电 平 值 ， 这 时 将 强 磁铁 靠近 霍 尔 传感器 ， 观 察 电压 值 是 否 变 低 了 ， 如 果 电 压 值 
没有 足够 低 ， 这 时 把 磁铁 翻 过 一 面 再 靠近 霍 尔 传感器 ， 然 后 再 观察 霍 尔 传 感 絮 的 信号 线 的 电 
平 变 化 ， 堆 尔 传感器 的 检测 结果 是 否 存 在 极 性 问题 ， 请 同学 们 在 实验 室 验证 。 

3) 观察 实验 板 原 理 图 ， 找 出 单片机 的 RBO (33 号 引 脚 ) ， 并 用 插 接线 连接 霍 尔 传感器 
的 信号 线 与 单片机 的 外 部 中 断 引 脚 一 一 RB0。 

4) 在 MPLAB IDE 环境 下 利用 MPLAB ICD2 把 源 程序 下 载 到 单片机 中 ， 步 又 如 实验 一 中 
所 叙述 ， 并 用 磁铁 验证 该 实验 。 

堆 尔 传感器 在 奇数 次 检测 到 磁场 时 如 网 7-35 所 示 ， 此 时 4 个 灯 全 亮 。 

霍 尔 传感器 在 奇数 次 检测 到 磁场 时 ， 此 时 4 个 灯 全 灭 。 请 同学 们 做 完 每 个 实验 后 将 接 搬 
线 拆除 。 

5) 仔细 阅读 源 代码 ， 并 说 明 源 代码 实现 的 功能 (完成 思考 题 1 ) 。 

6) 请 同学 们 试 着 独立 编写 程序 完成 上 面 要 求 的 功能 。 

2. 光电 传感器 

要 求 : 用 单片机 的 中 断 功 能 记录 光电 对 射 管 被 遮挡 的 次 数 ， 并 在 四 位 LED 数码 管 的 低 
两 位 显示 出 来 。 只 要 求 记录 99 次 以 下 的 遮挡 次 数 。 
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图 7-35” 霍 尔 传感器 实验 演示 图 


步骤 : 

D 用 万 用 表 测 量 光 电 传 感 器 的 信号 线 ， 并 观察 其 电 平 值 ， 这 时 用 一 个 纸 片 挡 在 发 射 管 
与 接受 管 之 间 ， 再 观察 电压 值 是 否 变 低 了 ， 撤 离 遮 挡 物 以 后 电 平 恢 复原 置 值 ， 注 意 光 电 传 感 
器 的 信号 线 为 本 端子 右 侧 第 3 个 插 针 。 

具体 操作 如 图 7-36 所 示 。 


Be 


图 7-36 ”传感器 操作 示意 图 


2) 观察 实验 板 原理 图 ， 找 出 单片机 的 RBO 引 脚 ， 然 后 用 插 接 线 连接 光电 传 感 右 的 信号 
线 与 单片机 的 外 部 中 断 引 脚 一 一 RB0， 并 对 照 程序 与 实验 板 原理 图 用 接 插 线 连接 四 位 LED 
数码 管 与 单片机 ，J7 端子 插 针 由 下 向 上 分 别 为 个 、 十 、 百 、 千 ， 因 此 J 端子 个 位 插 针 与 单 
片 机 RA3 (5 号 引 脚 ) 相连 ,了 7 端子 十 位 插 针 与 单片机 RA2 (4 号 引 脚 ) 相连 ， 其 他 不 连 ， 
最 后 运行 程序 后 两 位 数码 管 显示 出 遮挡 次 数 。 

3) 在 MPLAB IDE 环境 下 利用 MPLAB ICD2 把 源 程序 下 载 到 单片机 中 ， 并 验证 实验 。 

4) 仔细 阅读 参考 源 代 码 并 理解 每 条 语句 的 相关 功能 (完成 思考 题 2) 。 
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5) 独立 编写 程序 完成 上 述 要 求 的 功能 。 

3. 温度 传感器 

要 求 : 使 用 温度 传感器 测定 周围 环境 温度 ， 用 摄氏 度 为 单位 ， 并 且 通 过 串口 通信 发 送 到 
计算 机 的 串口 助手 中 显示 出 来 ， 要求 波 特 率 为 9600bit/s， 并 且 在 数码 管 上 显示 温度 值 精确 
到 摄氏 度 。 

D 

1) 观察 温度 传感器 的 外 形 ， 这 里 温度 传感器 的 信和 号 线 在 本 端子 左边 第 1 个 插 针 ， 同 学 
们 在 以 后 的 独立 开发 应 用 中 不 要 和 弄 错 。 

2) 观察 实验 板 原理 图 ， 找 出 单片机 的 RAI (3 号 引 脚 )， 用 插 接线 连接 温度 传感器 的 
信号 线 与 单片机 的 外 部 中 断 引 脚 一 一 RA1 (可 以 连 到 其 他 普通 10 口上 ， 本 程序 以 连接 到 
RAI 为 例 ) ， 并 对 照 程序 用 接 插 线 连接 四 位 LED 数码 管 与 单片机 ，J7 端子 个 位 与 单片机 
RC1 (16 号 引 脚 ) 相连 ，J 端子 十 位 与 单片机 RC0 (15 号 引 脚 ) 相连 。 

3) 在 MPLAB IDE 环境 下 利用 MPLAB ICD2 把 源 程序 下 载 到 单片机 中 ， 并 在 实验 板 上 验 
证 。 

4) 仔细 阅读 温度 传感器 的 源 代码 ， 在 阅读 的 过 程 中 ， 把 主要 精力 放 在 主 酚 数 上 ， 了 解 
温度 传感器 的 操作 顺序 (命令 的 发 送 顺序 ) ， 各 个 功能 模块 函数 已 经 实现 ， 由 于 同学 们 的 课 
程 时 间 较 紧张 ， 在 这 里 不 要 求 同 学 们 自己 编写 了 ， 完 成 思考 题 3 即 可 。 

4. 超声 波 传感器 

超声 波 的 发 送 电路 是 通过 LC 振荡 实现 电压 放大 的 ， 而 在 振荡 的 过 程 中 存在 瞬间 短路 现 
象 ， 如 图 7-37 Bros , 24 SEND 为 高 电 平时 ， 唱 体 管 处 于 导 通 状态 ， 这 是 电源 通过 电感 经 过 
晶体 管 直 接 流 入 地 ， 这 个 瞬间 要 求 很 短 ， 经 过 一 个 短暂 的 瞬 态 ， 电 感 中 的 电流 已 经 达到 了 一 
定 的 大 小 ， 此 时 SEND 变 为 低 电 平 ， 唱 体 管 截止 ， 电 流 不 能 通过 晶体 管 ， 但 是 由 于 电感 的 自 
感 效 应 ， 会 在 电容 量 两 端 充 电 ， 并 且 电 压 升 到 将 近 30V， 如 此 反复 ， 就 在 晶体 管 的 集 电 极 形 
成 了 振荡 的 电压 ， 我 们 给 出 的 SEND 端 信号 为 40kHz 的 方 波 信号 ， 而 在 集 电极 处 我 们 得 到 了 
峰 - 峰 值 约 为 30V 的 振荡 电压 ， 我 们 将 这 个 电压 加 到 超声 波 的 发 射 探 头 上 就 可 以 发 射 一 定 功 
率 的 超声 波 了 。 

而 这 种 发 射电 路 ， 就 决定 了 我 们 绝对 不 能 让 SEND 
端的 高 电 平 时 间 过 长 ， 只 要 不 是 在 发 射 状态 就 必须 要 求 
SEND 端 处 于 低 电 平 状态 。 2 

电路 示意 如 图 7-37 所 示 。 

要 求 : 实现 超声 波 测 距 ， 并 且 在 数码 管 上 显示 出 具 
体 值 。 

MR: 

1) 观察 实验 板 原 理 图 ， 找 出 单片机 的 RBO (33 号 OnRSNN Rs 
引 脚 ) 与 RC2 (17 号 引 脚 ) ， 用 接 插 线 将 SEND Xm (JP2 于 和 NPN 470 
端子 的 下 侧 插 针 ) 与 RC2 相连 (RC2 是 单片机 的 PWM 
输出 端 ) ， 将 RECEIVE 端 (JP2 端子 的 上 侧 插 针 ) 与 2n 


RBO 相连 (外 部 中 断 ) 。 注 意 : 板子 上 的 SEND 和 RE- 
CEIVE 写 反 了 图 7-37 ”超声 波 传感器 振荡 电路 示意 
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2) 对 照 程 序 与 实验 板 原 理 图 用 接 插 线 连接 四 位 LED 数码 管 与 单片机 ，J7 端子 个 、 十 、 
百 、 千 插 针 分 别 与 单片机 RA3 (5 号 引 脚 ) RA2 (4 号 引 脚 ) , RAI (3 号 引 脚 ) , RAO (2 
号 引 脚 ) 相连 。 

3) 在 MPLAB IDE 环境 下 利用 MPLAB ICD2 把 源 程序 下 载 到 单片机 中 ， 并 对 照 程序 与 实 
验 板 原理 图 用 接 插 线 连接 四 位 LED 数码 管 与 单片机 。 

超声 波 传感器 实验 运行 结果 如 网 7-38 所 示 。 
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图 7-38 ”传感器 实验 运行 结果 


4) 用 示波器 观察 发 射 探 头 上 的 波形 ， 认 真 体 会 超声 波 测 距 的 原理 。 用 示波器 观察 接收 
端的 信号 波形 ， 用 两 路 示波器 同时 观察 发 送 与 接收 端的 波形 ， 体 会 时 差 测 距 的 思想 。 
5) 仔细 阅读 给 出 的 源 代码 并 理解 相关 语句 的 功能 〈 完 成 思考 题 4) 。 


五 、 思 考题 

1. 在 替 尔 传感器 实验 中 给 出 的 源 代码 实现 的 功能 是 什么 ?用 简洁 的 语言 概括 出 来 。 

A. 在 奇数 次 中 断 到 来 时 点 亮 所 有 4 个 LED XT, 偶数 次 中 断 到 来 时 关闭 所 有 LED £T, 

2. 设计 一 个 光电 对 射 管 的 简单 应 用 。 谈 谈 自 己 的 创意 。 

利用 光电 开关 还 可 以 进行 产品 流水 线 的 产量 统计 、 对 装配 件 是 否 到 位 及 装配 质量 进行 检 
iU. ， 例 如 瓶 盖 是 和 否 压 上 、 商 标 是 否 漏 贴 ( 见 图 7-39) ， 以 及 送料 机 构 是 否 断 料 ( 见 图 7-40) 
等 。 

此 外 ， 利 用 光电 传 感 细 可 以 检测 布料 的 有 无 和 宽度 。 利 用 遮挡 式 光电 传 感 涡 检测 布料 的 
下 垂 度 ， 其 结果 可 用 于 调整 布料 在 传送 中 的 张力 ， 利 用 安装 在 框 架 上 的 光电 传感器 可 以 发 现 
漏 装 产品 的 空 箱 ， 比 利用 油缸 将 空 箱 推出 。 
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光电 开关 
Kd 7-39 ”瓶子 龟 装 检测 示意 图 图 740 送料 机 构 检 测 示意 图 


3. 总 结 温 度 传感器 的 命令 发 送 的 顺序 ? 

答 :〈 注 : 如 果 命 令 发 送 顺序 发 送 不 正确 ， 温 度 传感器 不 能 工作 ， 还 有 在 传输 数据 的 过 
程 中 关键 部 分 的 延 时 也 是 要 求 很 严格 的 ， 在 应 用 中 如 果 命 令 顺 序 正 确 而 温度 值 不 能 读 出 ， 大 
多 数 情 况 下 都 是 在 数据 传输 过 程 中 的 时 间 延 迟 不 正确 ， 但 是 本 次 试验 中 的 这 部 分 源 代码 已 经 
给 出 ， 要 求 同 学 们 深刻 理解 温度 传感器 的 使 用 方法 ， 做 到 在 以 后 的 应 用 中 会 用 温度 传感器 测 
定 环境 温度 。) 

4. 在 测量 距离 的 过 程 中 ， 发 射 探头 为 什么 不 能 一 直 都 发 送 超声 波 ， 而 是 采用 瞬间 发 送 
然后 停止 发 送 的 方法 实现 测量 距离 的 功能 。 

答 : 超声 波 传感器 在 测量 较 远 距离 的 障碍 物 是 非常 有 优势 的 ， 然 而 在 物体 里 测量 系统 非 
常 紧 的 时 候 就 显得 有 劣势 了 。 这 主要 是 因为 超声 波 的 测 距 过 程 是 这 样 的 ， 首 先 在 很 短 的 时 间 
内 (0.25ms 左右 大 约 发 射 10 个 周期 的 超声 波 ) 然后 就 关闭 发 射 ， 打 开 中 断 等 待 超声 波 的 发 
射 波 。 当 反射 波 到 来 时 经 过 发 射电 路 后 ， 触 发 单片机 的 中 断 ， 在 发 射 和 中 断 触 发 这 段 时 间 内 
就 是 超声 波 在 物体 与 测 距 仪 间 的 传播 时 间 ， 如 果 我 们 采用 连续 发 射 的 方式 ， 在 超声 波 发 出 并 
发 射 回来 后 ， 超 声波 在 接收 探头 处 就 是 连续 存在 的 ， 这 对 于 单片机 来 说 此 种 形式 的 信息 里 是 
不 存在 距离 信息 的 ， 是 不 能 完成 测 距 的 。 


实验 三 ” 艇 机 控制 实验 


一 、 实 验 目的 


1) 了 解 艇 机 的 原理 和 控制 方法 。 

2) 掌握 单片机 的 定时 器 模块 的 使 用 。 
3) 学 会 利用 定时 器 来 生成 PWM 波 。 
二 、 实 验 设备 


PC 一 台 (PC 上 安装 MPLAB IDE 软件 ) 、 在 线 调 试 器 MPLAB ICD2 、 目 标 电 路 板 、 舵 机 


o 


三 、 实 验 原理 


1. 舵 机 的 工作 原理 
机 器 人 的 动力 来 源 都 是 能 机 ， 肯 入 式 系统 主要 控制 的 对 象 就 是 能 机 ， 对 能 机 必须 有 一 个 


一 个 
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清楚 的 认识 。 舵 机 是 一 种 位 置 伺服 的 驱动 器 ， 适 用 于 那些 需要 角度 不 断 变 化 并 具有 保持 力矩 
的 控制 系统 。 舵 机 的 工作 原理 是 控制 电路 板 接受 来 自信 号 线 的 控制 信号 ， 控 制 电动 机 转 
动 ， 电 动机 带动 一 系列 齿轮 组 ， 减 速 后 传动 至 输出 舵 盘 。 舵 机 的 输出 轴 和 位 置 反馈 电位 器 是 
相连 的 ， 舵 盘 转动 的 同时 ， 带 动 位 置 反 馈 电 位 器 ， 电 位 需 将 输出 一 个 电压 信号 到 控制 电路 
板 ， 进 行 反馈 ， 然 后 控制 电路 板 根据 所 在 位 置 决定 电动 机 的 转动 方向 和 速度 ， 从 而 达到 目标 
停止 。 

控制 信号 由 接收 机 的 通道 进入 信号 调制 芯片 ， 获 得 直流 偏 置 电压 。 它 内 部 有 一 个 基准 电 
路 ， 产 生 周 期 为 20ms， 宽 度 为 1.Sms 的 基准 信号 ， 将 获得 的 直流 偏 置 电压 与 电位 器 的 电压 
比较 ， 获 得 电压 差 输 出 。 最 后 ， 电 压 差 的 正 负 输 出 到 电动 机 驱动 芯片 ， 决 定 电 动机 的 正 反 
转 。 当 电动 机 转速 一 定时 ， 通 过 级 联 减 速 齿轮 带动 电位 器 旋转 ， 使 得 电压 差 为 0， 电 动机 停 
止 转动 。 舵 机 内 部 结构 如 图 7-41 所 示 。 

电动 机 : 为 舵 机 提供 动力 。 

减速 箱 : 将 电动 机 的 高 转速 降低 ， 并 获得 大 的 转 矩 。 

电位 器 : 为 系统 提供 输出 轴 的 反馈 。 

电子 控制 板 : 用 来 分 析 控制 信号 和 反馈 位 置 直 接 的 关系 ， 控 制 电动 机 正 转 、 反 转 还 是 停 
机 。 真 正 的 舵 机 如 图 7-42 所 示 。 


d — uo 


电动 机 — 
eA... 板 


图 7-41 舱 机 内 部 结构 图 7-42 ES BLA 


2. 舵 机 的 PWM 控制 方式 
采用 的 是 日 本 KONDO 公司 生产 的 KRS786ICS 舵 机 ， 这 种 舵 机 是 专门 为 双 足 步行 机 器 人 
设计 的 舵 机 ， 其 具体 参数 见 表 7-3 。 
表 7-3 KRS7861CS 舵 机 参数 


舵 机 名 称 尺寸 /mm 重量 /g 速度 力矩 7N * em 周期 /ms 控制 范围 /4 (°) 
KRS7861CS 31 x16 x30.2 35 0. 23s/60? TI.42 8-20 -90 - 90 


舵 机 的 控制 信号 的 特征 ， 如 图 7-43 所 示 ， 舵 机 控制 信号 为 周期 从 8 ~ 20ms 可 以 任意 选 
择 的 脉 宽 调 制 (PWM) 信和 号， 脉冲 宽度 为 0.7 ~2. 3ms 的 范围 ， 对 应 于 -90。~ 9098955 ff 15 
围 ， 如 图 7-44 所 示 。 舵 机 控制 信号 的 高 电 平 为 3 ~6V， 低 电 平 为 0~0.8V。 

与 直流 电动 机 相 比 较 ， 舵 机 的 控制 要 简单 很 多 ， 主 要 是 因为 它 有 一 个 内 置 的 控制 器 ， 于 
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Je HA REM SEE GR UR RARE. BLEHBRCAGVR SUA PC 下 载 给 它 的 数据 之 后 ， 根 
HRE IRI T REL S JUPE p ETE, HEP Fed f e. 


脉冲 宽度 /ms 


8ms « F « 20ms 
k 7 23r 


-90 *90 ”能 机 角度 Mo) 


0.7ms< 脉 宽 <2.3ms 


图 743 能 机 的 控制 信号 图 7-44 能 机 的 角度 和 脉冲 宽度 之 间 的 关系 图 


今后 为 了 运算 和 使 用 方便 ， 把 舵 机 的 - 90" 规 定 为 0"， 把 舵 机 的 90° 规 定 为 180*， 相 当 
于 把 参考 坐标 系 向 左 移 动 了 90。， 即 如 图 7-45 所 示 的 本 系统 中 使 用 的 舵 机 角度 和 脉冲 宽度 之 
间 的 关系 图 ， 并 且 将 舵 机 的 控制 信号 定 为 周期 是 
20ms uio 言 号 ， 其 中 脉冲 宽度 从 0. 5 ~ 2. 5ms, 
相对 应 舵 盘 的 位 置 为 0 ~180"， 呈 线性 变化 。 也 就 是 
说 ， 给 它 提供 一 定 的 脉 宽 ， 它 的 输出 轴 就 会 保持 在 一 
个 相对 应 的 角度 上 ， 无 论 外 界 转 矩 怎样 改变 ， 直 到 给 
它 提供 一 个 另外 宽度 的 脉冲 信号， 它 才 会 改变 输出 角 
度 到 新 的 对 应 的 位 置 上 。 0 180 SEBL/S HEIC) 
. 利用 PIC (PICIGF877A) 单片机 定时 器 1 生 
成 PWM 控制 信号 

PIC 单片机 有 Timer0、Timerl 、Timer2 三 个 定时 
器 ， 双 足 步 行 机 器 人 用 Timer0 做 看 门 狗 ， 以 防止 程序 跑 飞 ; 用 Timerl 来 定时 比较 ， 生 成 24 
路 PWM 波 。 下 面 就 介绍 一 下 Timerl (Timer0 和 Timer2 在 一 些 用 法 方面 和 Timerl 相似 ) 。 

Timer! 模块 是 由 两 个 可 读 写 的 8 位 寄存 器 (TMRIH WI TMRIL) 组 成 的 16 位 定时 器 / 计 
Jo. TMRI 寄存 器 (TMR1H: TMRIL) 从 0000h 开始 加 1 记 数 ， 一 直 加 到 FFFFh Ji, ff 
加 1 又 循环 回 到 0000h。 如 果 人 允许 Timerl 中 断 ， 则 定时 器 溢出 的 时 候 中 断 标志 位 TMRIIF 置 
位 ， 而 产生 Timerl 中 断 。 中 断 的 使 能 /禁止 可 以 通过 置 位 /清除 TMRITE 中 断 使 能 位 来 设置 。 

TICON: Timerl 控制 寄存 器 ， 用 来 控制 Timerl 的 工作 模式 ， 其 数据 位 定义 如 图 7-46 所 
示 。 


W 


图 7-45 实用 的 舵 机 角度 和 
脉冲 宽度 之 间 的 关系 图 


U-0 U-9 R/W-0 R/W-0 RWO R/W-0 R/W-0 


| [|  Lrekes | rickeso. | TlosCEN TMRICS | TMRION 


bit 7 bit 0 


图 7-46 Timer! 控制 寄存 器 TI CON 的 数据 位 定义 


bit 7:6 未 定义 ， 始 终 读 为 “0”。 
bit 5:4 
TICKPSI. TICKPSO: Timerl 输入 时 钟 预 分 频 选 择 
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11 21:8 预 分 频 值 ; 
10 =1:4 预 分 频 值 ; 
01 21:2 预 分 频 值 ; 
00 =1:1 预 分 频 值 。 
bit 3 
TIOSCEN: Timer! 内 部 振荡 器 使 能 位 。 
当 TLOSCEN =1 时: 打开 内 部 振荡 器 ， 反 相 放 大 器 工作 ， 需 外 接 晶体 产生 振荡 时 


当 T1OSCEN =0 时 : 振荡 器 被 关闭 。 振 荡 器 的 反 相 器 和 反馈 电阻 被 天 。 
bit 2 
TISYNC: Timerl 外 部 时 钟 输入 同步 控制 位 。 
当 TMRICS =1 时 : 不 同步 外 部 时 钟 。 
当 TMR1CS =0 时 : 同步 外 部 时 钟 。TMR1CS =0 时 Timer! 使 用 内 部 时 钟 。 
bit 1 
TMRICS; Timerl 时 钟 源 选择 位 。 
当 TMR1CS 21 Bf; 选择 TIOSOZTICKI 引 脚 的 外 部 时 钟 (上 升 沿 计 ) 。 
M TMRICS =0 Bf. 选择 内 部 时 钟 (FOSC/A), 
bit 0 
TMRI1ON ， Timerl 使 能 位 
当 TMRION =1 时 : 使 能 Timerl 。 
当 TMRION =1 时 : 关闭 Timerl 。 
双 足 步行 机 器 人 用 到 的 是 Timerl 的 定时 功能 ,将 TMR1CS (TICON 控制 寄存 器 bitl ) 


i0, 选择 TMRI 工作 在 定时 器 模式 。 在 这 种 模式 下 ， 定 时 器 的 输入 时 钟 是 内 部 时 钟 频率 的 
4 分 频 (fi,./4)。 因 为 内 部 时 钟 总 是 同步 的 ， 所 以 同步 控制 位 TISYNC (TICON 控制 寄存 带 


osc 


bit2) 此 时 不 起 作用 。 


Timerl 初始 化 : 
void InitTimer (void) 
| 
OPTION | =0x0F; // 开 启 看 门 狗 ， 分 频 为 1: 128 (Timer0 ) 


TI CON 20; // 工 作 在 定时 模式 
TMRIIE -0; // 关 中 断 
TMRIIF =0; // 清 除 溢出 标志 


| 
由 于 我 们 使 用 的 舵 机 控制 波形 为 高 电 平 延 时 在 0.5 ~ 2. Sms 的 方 波 ， 我 们 可 以 通过 Tim- 


erl 定时 ， 比 如 我 们 要 让 某 一 引 脚 (如 RDI) 输出 高 电 平 延 时 为 1. 5ms， 周 期 为 20ms 的 方 


波 ， 


我 们 可 以 这 样 做 : 
(DRDI = 高 电 平 ; 
@) 延 时 1. 5ms; 

®RDI = 低 电 平 ; 
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DER} 18. 5ms; 

SEE I-—IV, 

所 以 我 们 只 需要 再 写 一 个 延 时 函数 即 可 ， 代 码 如 下 : 
void Delay (U8 TH, U8 TL) 


TMRIH - TH; // Load delay time High 
TMRIL - TL; // Load delay time Low 
TMRION = I; // 打 开 timerl 


while (! TMRIIF) // 等 待 计 数 溢出 
CLRWDT (); // 清 除 看 门 狗 


TMRIIF = 0; // 清 除 标志 位 
TMRION = 0; // XH] timerl 


| 

很 显然 ， 我 们 只 要 知道 延 时 1. Sms， 单 片 机 需要 运行 多 少 条 指令 就 行 了 。 下 面 就 来 详细 
计算 一 下 : 

PIC 单片机 晶振 为 20MHz， 定 时 器 的 输入 时 钟 是 内 部 时 钟 频率 的 4 分 频 (fsc/4)， 也 就 
是 说 ， 一 条 指令 需要 (A/fuc) s-4/20MHz =0.2us， 定 时 1. Sms 就 需要 执行 1. 5ms/0. 2 us 
-7500 条 指令 ， 所 以 定时 器 每 次 重 装 的 计数 初 值 为 0xffff -7500， 即 TMRI = 0xffff - 7500, 
从 而 得 出 : 

TMRIH = (Oxffff — 7500)/256 = HIGH ; 
TMRIL = (Oxffff — 7500)96256 = LOW; 

在 程序 中 s 

TIME _ CONST uS H(x) ((Oxffff - ( (x) * (FOSC/4/1000000) ) )/256) 

TIME CONST uS L(x) ((Oxffff — ((x) * (F0SC/4/1000000) ) ) 96256) 

来 表示 x 微 秒 的 时 间 常 数 。 

这 样 ，Delay(TIME CONST uS H(Angle)、TIME CONST uS L(Angle) ) 就 表示 延 
时 Angle 微 秒 了 。 

我 们 要 生成 连续 的 周期 为 20ms、 高 电 平 延 在 0.5 ~2. 5ms 的 方 波 来 控制 舵 机 就 很 容易 了 
(因为 高 电 平 延 在 0.5 ~2. 5ms， 所 以 低 电 平 延 在 17.5 ~19.$ms) ， 代 人 码 如 下 : 

void PWM( U16 Angle) 

| 

DUOJI RUN; 

// 高 电 平 正 时 

Delay( TIME CONST u$ H(Angle), TIME CONST uS L(Angle)); 
DUOJI STOP; 


// IK FA SÉ SEIS] 17. 5ms 
Delay( TIME CONST uS H(10000), TIME CONST uS L(10000)); 
Delay( TIME CONST uS H(7500), TIME CONST uS L(7500)); 
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// 减 去 高 电 平时 间 ,确保 周期 在 20ms 
Delay( TIME CONST uS H(2500 Angle), 


TIME CONST uS L(2500- Angle)); 


| 
注意 控制 舵 机 必须 是 连续 的 方 波 ,一 个 周期 的 方 波 是 不 行 的 ， 所 以 连续 调用 PWM ( ) 


就 可 以 了 。 


四 、 实 验 步 又 


1. 运行 MPLAB IDE 

要 启动 IDE， 安 装 后 双击 桌面 上 的 图 标 。 

2. 创建 项 目 

具体 步 又 如 下 : 

1) 选择 Project 一 Project Wizard , 单 击 下 一 步 ， 选择 器 件 PICI6F877A, 单 击 下 一 步 。 
2) 选择 语言 工具 : 在 Active Toolsuite 框 中 选 HI-TECH PICC Toolsuite ， 单 击 下 一 步 。 

3) 输入 工程 名 和 工程 所 在 的 路 径 ， 单 击 下 一 步 ; 这 里 我 们 设 工 程 名 为 fist， 存 在 路 径 


d: \ first\ 下 。 


4) 如 果 所 建 工程 路 径 下 已 经 有 了 写 好 的 C 文件 ， 可 以 直接 添加 到 工程 中 ， 若 没有 ， 直 


接 单 击 下 一 步 。 


5) 单 击 完成 ， 项 目 工程 建立 完成 。 

3. 编写 程序 

具体 步 又 如 下 : 

1) 单 击 File9New 新 建 一 个 文件 ， 编 写 程序 代码 ， 完 整 代 码 如 下 (注意 RD1 引 脚 要 设 


为 输出 ) : 
/ * 
MET EEEEEEEEE EEEE EEEE EEE EEEE EEEE EEEE EEEE EEE EEEE EEEE 
"E 
p 北京 科技 大 学 王 志 良 类 人 机 器 人 实验 室 
"E 
"E File Information * 
* 


* File name : PWM. C 
* Function : 熟悉 Timer ERFAR Jf HH , 228 [8 FHAE SERA E X, PWM 波 来 控制 


s :能 机 

* Notice : MCU;PICI6F877A 

* 

* Latest version information * 
* Author : Xuwenxue 

* Modified Date : 2006-821 


* Version : v1. 0.1 
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P History version infomation * 

; * Author : Xuwenxue 

; * Created date : 2006-8-21 

; * Version . v1. 0.0 

p * 


; LLLLLLLLLLLDLDLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLLILI 


Hinclude < pic. h > // 包 含 PIC 头 文件 

typedef unsigned char U8; // 无 符号 8 位 (0 ~255 ) 

typedef signed char I8 ; // 有 符号 8 位 ( -128 -127) 

typedef unsigned int U16; // 无 符号 16 位 (0 ~65535 ) 

typedef signed int I16 ; // 有 符号 16 位 ( -32768 ~32767 ) 

#define FOSC 20000000 // 定 义 晶 振 为 20MHz 

#define INS 5 // 定 义 1ps 所 需 的 指令 数 

#define DUOJI RDI // 能 机 控制 口 定 为 CH4 通道 ,对 应 引 脚 为 RD1 


define DUOJI RUN DUOJI=1 — //PWM 波 的 高 电 平 , 高 电 平 的 时 间 对 应 舵 机 的 转 
//ff ,0. 5 -2. 5ms 对 应 0 ~ 180° 
#define DUOJI STOP DUOJI 20 — //PWM 波 的 低 电 平 


//sdefine TIME CONST uS H(x) 

( COxffff — ( (x) * ( FOSC/4/1000000) ) )/256) 
//sdefine TIME CONST uS L(x) 

( (Oxffff — ( (x) * (FOSC/4/1000000) ) ) % 256) 


define TIME CONST uS H(x) ( COxffff — ( (x) * INS) )/256) 
#define TIME CONST uS L(x) ( COxffff — ( (x) * INS) ) 96256) 


VEETEE EEEE sehe b ok sje ook b oj sese deb jojo he ob ojos ode he op oj sese dede op ojo hehe ok sese he de keel he de obese sede ke oko ote 
* Function: void InitTimer( void ) 
* Use: Initialize timers 
* Input parameter; none 
* Output parameter; none 
keokekokeseoke ok jejeje sek ok ok ojo sek joke denke oj ojos he ok ojos de denk oj sese he denke ojo de hehe ok sese o o k kkk / 
void InitTimer( void ) 
| 
OPTIONI = 0x0F; /开启 看 门 狗 ,分 频 为 1: 128(Timer0 ) 
TICON = 0; /工作 在 定时 模式 
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TMRIIE - 0; / LP BE 
TMRIIF = 0; // 清 除 溢出 标志 


| 


Aaiaoe ooo eo oo ookko kkk kk 
* Function: void Delay ( U8 TH, U8 TL) 
* Use: Accurate delay function( using timerl ) 
* Input parameter; TH; Value for TMRIH; TL: Value for TMRIL 
* Output parameter; none 


stesse jette eate dee jo testet deese je tete seated je tede nteseateeeesje dente / 
void Delay( U8 TH, U8 TL) 


TMRIH - TH; // Load delay time High 
TMRIL - TL; //Load delay time Low 
TMRION = 1; // FTF timerl 


while(! TMRIF); /等待 计 数 溢出 
CLRWDT();， /清除 看 门 狗 


TMRIIF = 0; // 清 除 标 志 位 
TMRION = 0; // XH] timerl 


| 

/** 

void Delay( U8 TH, U8 TL) 
| 


asm 
BCF STATUS, RPO 
movlw TH 
movwf TMR1H//Load delay time High 
movlw TL 
movwf TMRIL//Load delay time Low 
bsf TI CON, TMRION 
loop btfsc PIRI , TMRIIF 
// asm(" clrwdt ") 
bcf PIR1,TMRIIF 
bcf TICON, TMRION 


Zendasm 
*/ 

ET ————————————— —— kk 
* Function: void PWM(U16 Angle) 


* Use: PWM function( using timerl ) 
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* [nput parameter; Angle: Value for the position of the motor 
* Output parameter; none 
akooo kooo kkk k / 
void PWM( U16 Angle) 
| 
DUOJ RUN; 
// 高 电 平时 间 ,对 应 舵 机 角度 
Delay( TIME CONST u$ H(Angle),TIME CONST uS L(Angle)); 
DUOJI _ STOP; 
Delay ( TIME CONST u$ H(10000), TIME CONST uS L(10000)); 
Delay( TIME CONST uS H(7500), TIME CONST uS L(7500)); 
// 确 保 周期 为 20ms 
Delay( TIME _ CONST uS H(2500 - Angle), 
TIME CONST u$ L(2500 - Angle) ) ; 
| 
void main(void ) 


| 


U16 i-0; 
InitTimer( ) ; // 初 始 化 定时 器 
TRISD & = ~(1 <<1); /设置 RD1 为 输出 ,以 便 输出 PWM 
while( 1) 

| 
i+ +; 


if( (1«250) &&(i»0)) 
PWM (500) ;// 高 电 平 延 时 为 0.Sms, 周 期 为 20ms 方 波 , 舵 机 对 应 位 置 应 为 0? 
else if( (1«500) &&(i» =250) ) 
PWM(1500) ;// 高 电 平 延 时 为 1. Sms ,周期 为 20ms 方 波 , 舵 机 对 应 位 置 应 为 90? 
else 
PWM(2400) ;// 高 电 平 延 时 为 2. 4ms ,周期 为 20ms 方 波 , 舵 机 对 应 位 置 应 
Æ 180° 
if(i»750)i =0 


我 们 通过 改变 PWM 函数 的 参数 在 500 ~2500 之 间 变 动 就 可 以 实现 舵 机 转角 变化 了 ， 可 
以 在 程序 中 设置 一 个 i iat 加 一 ， 到 一 定时 间 程序 自己 改变 函数 的 参数 就 行 了 。 实 现 
舵 机 转速 的 变化 也 是 这 个 道理 ， 只 是 改变 的 时 间 长 短 的 不 同 。 

2) 保存 这 个 文件 到 d: V first\ 文件 下 ,文件 名 为 first. co 

3) 添加 first. c 到 工程 中 去 ， 右键 单 击 source files, WF% “add files”， 找 到 fisrt c, HM 
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去 即 可 。 

4) 保存 工程 ， 单 击 File 一 Save Workspace, 

4. 连接 MPLAB ICD2 

具体 步骤 如 实验 一 所 示 。 

5. 调试 程序 

设置 芯片 的 配置 字 、 编 译 程序 和 下 载 程序 等 如 实验 一 所 示 ， 下 载 完 程序 之 后 ， 将 ICD2 
和 目标 演示 板 断 开 ， 将 艇 机 连 到 RDI 插口 ， 我 们 就 会 看 到 艇 机 的 舵 盘 转动 起 来 ， 先 转 90°， 
再 转 90"， 然 后 再 回转 180°* ， 用 示波器 看 一 下 输出 的 波形 对 不 对 。 


五 、 思 考题 


1. 舵 机 是 如 何 控 制 的 ， 和 普通 直流 电动 机 有 什么 不 同 ? 

答 : 通过 周期 在 20ms 左右 ， 高 电 平 在 一 定 范围 的 PWM 波 来 控制 ， 不 同 舵 机 高 电 平 范 
围 不 同 ， 具体 看 舵 机 参数 。 直 流 电 动机 也 可 以 通过 PWM 来 控制 ， 所 不 同 的 是 ， 直 流 电动 机 
PWM 是 用 来 调 速 的 ， 而 舵 机 则 是 调 位 置 的 ， 事实 上 艇 机 内 部 也 是 个 小 直流 ， 不 过 在 艇 机 内 
部 还 有 个 用 来 反馈 电路 板 ， 通过 PWM 来 调整 所 要 转 的 角度 。 

2. 简 述 利用 Timerl 生成 PWM 的 过 程 ? 

答 : TIMERI 就 是 用 来 定时 ， 先 将 某 引 脚 置 高 R), ， 定 时 一 段 时 间 后 再 将 该 引 脚 置 低 
(高 ) ， 再 定时 一 段 时 间 将 该 引 脚 置 高 〈 低 ) ， 如 此 反复 即 可 。 

3. Timerl 最 多 能 定时 多 长 时 间 ? 

答 : 这 需要 根据 外 围 晶 振 的 频率 来 定 ， 我 们 知道 单片机 一 条 指令 耗 时 : (4/7f,.) s, Tim- 
erl 是 一 个 16 位 定时 器 ， 所 以 能 从 0 加 到 65535 ， 也 就 是 说 最 多 能 加 65536 个 指令 ， 当 从 0 
加 到 65535 时 也 就 定时 了 65536 * (4 和 )s， 这 也 是 最 大 值 。 比 如 我 们 的 晶振 是 20MHz 的 ， 
所 以 最 多 能 延 时 13. 1072ms， 所 以 要 注意 程序 中 (TIME CONST u$ H(x), TIME CONST 
uS L(x)) B x EG mA, X-13107, 


实验 四 ”机械 结构 设计 与 认识 实验 


一 、 实 验 目的 

1) 认识 双 足 步行 机 器 人 的 自由 度 。 

2) 掌握 双 足 步行 机 需 人 机 械 结构 。 

3) 熟悉 舵 机 初始 角度 和 初始 姿态 对 安装 机 器 人 的 影响 。 

4) 学 会 组 装 双 足 步行 机 器 人 。 

二 、 实 验 设备 

机 器 人 组 装 件 一 套 、 舵 机 17 台 、 机 器 人 控制 咒 一 个 、 若 干 螺钉 。 

三 、 实 验 原理 与 说 明 

1. 关于 机 器 人 自由 度 的 说 明 

目 由 度 从 广义 上 来 说 就 是 在 系 一 方向 上 能 够 旋转 或 移动 。 它 是 机 器 人 性 能 中 一 个 重要 的 
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参数 ， 和 艇 机 联系 在 一 起 ， 一 般 来 说 ， 有 多 少 个 舵 机 就 有 多 少 个 自由 度 。 在 设计 机 器 人 的 机 
械 结构 时 ， 要 考虑 到 机 器 人 的 仿 人 特点 。 在 每 个 关节 处 都 要 设立 自由 度 ， 那 样 才 能 完成 类 似 
人 的 动作 。 比 如 设计 机 器 人 腿 ， 至 少 要 有 5 个 自由 度 ， 分 别 是 通关 节 上 的 两 个 自由 度 、 肤 关 
节 上 的 一 个 自由 度 、 还 有 中 关节 上 的 两 个 自由 度 ， 这 样 就 可 以 完成 类 似 人 的 前 进 、 后 退 、 抬 
腿 、 俯 身 等 动作 ， 如 图 7-47 所 示 。 

2. 机 器 人 机 械 结 构 配 件 

图 748 所 示 的 机 器 人 ， 是 将 17 人 台 舵 机 
以 搭 积 木 的 方式 搭 成 人 形 的 。 机 体 大 部 分 是 
由 舵 机 组 成 的 ， 各 个 艇 机 之 间 是 由 一 些 饭 金 
件 连 接 而 成 。 为 了 保证 舵 机 之 间 能 够 有 效 地 
连接 ， 同 时 17 4 NE DLE ZH RE — I AOE , 
需要 有 合理 的 机 械 配 件 。 图 7-49 所 示 的 就 是 
机 器 人 所 需 的 配件 。 


四 、 实 验 步骤 


实验 (—) 机 器 人 组 装 

1) 用 螺钉 将 安装 的 配件 按 图 7-50 的 方 
式 组 装 在 一 起 ， 注 意 有 的 配件 有 许多 小 孔 ， 
在 组 装 时 ， 必 须 按 图 7-50 的 方式 组 装 ， 否 则 图 7-47 机 器 人 自由 度 说 明 
机 器 人 的 整体 外 形 将 会 有 变化 ， 不 利于 原 有 程序 操纵 。 


图 7-48 PLAE 图 7-49 ”所 需 配 件 
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图 7-$0 组 装 方式 示意 图 


2) 用 M2 x33mm 螺钉 将 配件 和 舵 机 组 装 在 一 起 ， 如 图 7-$1 所 示 。 注 意 在 安装 脚 部 舵 机 
时 ， 首 先 将 舵 机 的 外 壳 放 到 里 面 ， 然 后 将 舵 机 的 数据 线 从 配件 的 侧面 方 孔 穿 过 。 这 样 安装 才 
能 不 损坏 数据 线 和 舵 机 外 壳 。 


图 7-51 配件 艇 机 组 装 示意 
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3) 组 装机 器 人 的 两 个 上 上肢， 每 个 上 上 肢 由 两 个 舵 机 组 成 ,具有 2 个 自由 度 。 安 装 前 将 舵 
机 初始 的 角度 设 定 在 90"， 这 样 有 利于 能 机 有 摆动 的 余地 。 因 为 此 舵 机 最 大 动作 角度 是 
180° ， 当 把 安装 角度 设 在 90* 时 ， 与 配件 相配 合 不 会 发 生 运动 干涉 ， 可 以 顺利 地 完成 一 些 指 
定 的 动作 ， 如 图 7-52 所 示 。 


图 7-52” HLA EHE 


4) 组 装机 器 人 的 两 个 下 肢 ， 每 个 下 肢 由 4 个 能 机 组 成 ， 具 有 4 个 自由 度 。 安 装 前 还 是 
将 舵 机 初始 的 角度 设 定 在 99%。， 另 外 注意 在 安装 时 ， 大 腿 的 内 侧 有 配件 固定 如 图 7-53 所 示 。 

5) 组 装机 器 人 躯干 ， 由 4 个 舵 机 组 成 ， 具 有 4 个 自由 度 ， 控 制 胎 膊 前 后 旋转 和 大 腿 左 
右 摆动 。 安 装 前 还 是 将 能 机 初始 的 角 
度 设 定 在 9%。， 许 多 配件 是 由 螺钉 固 
定 , 为 了 美观 和 拆 印 方便 ， 螺 母 均 放 
在 里 面 。 在 安装 时 ， 先 从 一 面 开始 安 
装 ， 这 样 有 利于 紧 固 螺钉 。 此 处 由 于 
受到 空间 的 限制 ， 操 作 比 较 困难 ， 那 
么 在 安装 时 一 定 要 注意 每 个 螺钉 必须 
紧 固 牢 靠 ， 防 止 松懈 ， 如 图 7-54 所 
Ze 

6) 安装 机 器 人 控制 器 和 机 器 
头 ， 此 处 安装 比较 容易 。 先 将 上 肢 两 
个 舵 机 和 机 器 头 舵 机 的 数据 线 放 在 控 
制 器 板 的 下 面 ， 这 样 有 利于 整体 布置 
数据 线 。 然 后 用 3 个 螺钉 将 控制 器 固 
定 在 板 件 上 。 

7) 组 装 成 一 个 整体 ， 分 别 将 上 图 753 机 器 人 下 及 


131 


肢 和 下 肢 与 躯干 连接 在 一 起 。 注 意 在 安装 时 ， 大 腿 是 处 于 并 拢 状态 ， 胎 膊 处 于 伸 直 状态 ， 如 
图 7-55 所 示 。 


图 7-54 机 器 人 躯干 部 


图 7-55 整体 组 装 图 
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按照 以 上 步骤 就 会 完成 机 器 人 机 械 机 构 的 组 装 。 在 组 装 前 ， 首 先 要 有 整体 的 布局 ， 然 后 
再 分 步 组 装 。 相 信 通 过 以 上 的 图 片 和 文字 ， 你 一 定 会 成 功 组 装 成 一 个 具有 17 个 自由 度 的 双 
APT BUE A o 

实验 (—)  NWOBUBU UG E B3 ffi EREE AVERE A DS] 

1) 为 了 表现 机 带 人 拟人 特性 ， 当 通电 以 后 要 让 机 器 人 人 处 于 立正 状态 也 称 作 初 始 位 置 
(Homeposition) 。 初 始 位 置 是 机 器 人 类 似 于 人 类 ， 在 重力 的 作用 下 ， 正 处 于 能 量 最 低 的 消耗 
状态 。 在 每 个 机 带 人 组 装 完毕 后 ， 首 先 调试 出 的 就 是 初始 位 置 状态 。 图 7-56 和 图 7-57 分 别 
是 机 器 人 处 于 初始 位 置 的 正面 和 侧面 图 。 


图 7-56 ”机 器 人 正面 图 图 7-57 ”机 器 人 侧面 图 


2) 舵 机 的 初始 角度 是 在 安装 时 各 个 舵 机 所 处 的 角度 。 一 般 的 情况 下 ， 我 们 都 将 舵 机 调 
节 为 99"， 这 样 便于 安装 。 安 装 时 ， 大 家 可 能 有 这 样 的 体会 : DMR FERS, IEE 
处 于 垂下 状态 和 躯干 上 的 舵 机 连接 。 如 果 这 样 就 会 发 现 ， 刚 安装 的 腹 膊 不 能 够 举 过 头 部 ， 需 
要 重新 安装 。 因 为 刚才 安装 的 两 个 能 机 发 生 了 运动 干涉 ， 各 个 能 机 具有 耦合 关系 ， 虽 然 两 个 
舵 机 均 处 于 90° 的 状态 ,但 是 安装 以 后 两 个 舵 机 的 活动 空间 发 生 了 变化 。 读 者 可 以 按照 舵 机 
的 不 同 初始 角度 值 来 组 装机 器 人 ， 看 看 产生 何 种 结果 ? 

3) 机 器 人 的 初始 姿态 是 指 将 各 个 舵 机 连接 在 一 起 时 机 器 人 所 处 的 姿态 。 在 将 胸 膊 和 大 
腿 与 报 干 连接 时 ， 舵 机 的 初始 角度 都 调 到 90°*， 但 是 没有 按照 图 7-55 的 姿态 安装 ， 可 能 就 会 
产生 某 一 个 能 机 活动 干涉 ， 不 能 够 完成 类 人 动作 。 读 者 可 以 按照 不 同 的 姿态 安装 机 器 人 看 看 
产生 何 种 结果 。 


五 、 思 考题 


1. 说 一 说 本 实验 17 个 自由 度 机 器 人 的 自由 度 分 别 用 于 控制 哪个 方向 的 ? 
答 : 


[2 
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(1) ERA 6 个 自由 度 , 分 别 是 肩 部 两 个 自由 度 和 肘 部 一 个 自由 度 。 肩 部 两 个 自由 度 分 
别 控制 胜 膊 前 后 旋转 和 上 下 摆动 ， 肘 部 一 个 自由 度 控制 上 下 摆动 。 左 右 肢 对 称 共 6 个 自由 度 。 

(2) 下 肢 共 有 10 个 自由 度 , 分 别 是 脚 部 两 个 自由 度 、 膝 关节 一 个 自由 度 、 艇 关节 两 个 
自由 度 。 脚 部 两 个 自由 度 分 别 控制 脚 前 后 和 左右 的 摆动 ， 膝 关节 一 个 自由 度 控制 小 腿 前 后 摆 
动 ， 髋 关节 两 个 自由 度 分 别 控制 大 腿 前 后 和 左右 摆动 。 左 右 肢 对 称 ， 共 10 个 自由 度 。 

(3) 头 部 一 个 自由 度 控制 头 部 的 左右 旋转 。 

2. 说 出 Homeposition 值 和 初始 角度 值 的 区 别 ? 

答 : Homeposition 值 是 指 当 机 器 人 通电 以 后 ， 要 让 机 器 人 处 于 立正 状态 时 ，17 个 舵 机 的 
角度 值 。 它 是 在 每 个 机 器 人 组 装 完 毕 后 ， 首 先 调试 出 的 ,然后 才能 将 机 器 人 用 于 实践 
操作 。 

初始 角度 值 是 在 组 装机 器 人 时 ,为 了 使 17 个 舵 机 运动 不 发 生 干 涉 而 且 具 有 良好 操纵 性 ， 
将 17 个 舵 机 的 角度 值 分 别 调 到 90"， 就 是 初始 角度 值 。 它 是 在 机 器 人 组 装 时 ， 各 个 舵 机 和 
连接 件 之 间 的 相对 角度 。 

3. 请 说 出 舵 机 的 初始 角度 为 90" 和 机 器 人 的 初始 姿态 如 图 7-55 所 示 是 不 是 安装 机 器 人 
唯一 方法 ? 为 什么 ? 

答 : 舵 机 的 初始 角度 为 90" 和 机 器 人 的 初始 姿态 如 图 7-55 不 是 安装 机 器 人 唯一 方法 。 
为 艇 机 和 连接 件 之 间 的 相对 角度 可 以 是 任意 值 ， 不 一 定 是 90"， 但 是 为 了 容易 看 到 两 者 之 间 
的 角度 ， 也 就 是 垂直 或 平行 关系 ， 一 般 将 舵 机 在 安装 时 调 到 90" 。 


实验 五 ”简单 动作 调试 实验 


一 、 实 验 目的 


1) 和 掌握 双 是 步行 机 器 人 上 位 机 控制 软件 的 操作 。 

2) 熟悉 双 足 步行 机 器 人 上 位 机 软件 如 何 控制 舵 机 的 转动 。 

3) 学 会 机 器 人 初始 位 置 Homeposition 的 调试 。 

4) 学 习 使 用 上 位 机 控制 软件 ， 完 成 简单 动作 
对 动作 的 影响 。 

二 、 实 验 设备 

PC 一 台 (RA VC 程序 ， 双 足 步 行 机 器 人 上 位 机 控制 软件 ) 、 无 线 收 发 装置 (包含 无 线 
收发 盒 、 串 口 通 信 线 和 USB 数据 线 ) 一 套 、 类 人 双 足 步行 机 器 人 一 台 ，7.4V 充电 电池 一 
块 、 电 池 充 电 设备 (包含 12V/1A 稳 压 直流 电源 和 平衡 充电 器 ) 一 套 。 

三 、 实 验 原理 与 说 明 

关于 Homeposition 的 说 明 ; 

Homeposition， 是 机 器 人 良好 站 立 、 腿 部 各 舵 机 受 力 均匀 时 的 姿态 名 称 。 每 一 个 动作 数 


据 的 开始 和 最 后 都 是 使 用 的 这 个 姿态 。 机 需 人 在 安装 完毕 之 后 ， 应 首先 调试 出 Homeposi- 
tion。 图 7-58 和 图 7-59 SENLA Ak F Homeposition 的 正面 和 侧面 图 。 


招手 的 调试 ， 体 会 速度 控制 方式 不 同 
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图 7-58 | Homeposition 正面 图 图 7-$9 — Homeposition 侧面 图 


因为 每 一 个 动作 数据 的 开始 和 最 后 都 是 使 用 Homeposition 这 个 姿态 ， 它 的 调试 至 关 重 
要 ， 调 试 过 程 要 遵循 以 下 原则 : 

机 器 人 良好 直立 、 腿 部 各 舵 机 受 力 均 匀 ， 如 图 7-59 RART, Boc. BRT, ER 
关节 四 个 舵 机 侧面 的 舵 盘 在 同一 个 直线 上 ， 两 条 腿 调试 结束 后 各 对 应 舵 机 在 同一 平面 上 。 实 
验 步 又 的 实验 (—) 中 具体 介绍 如 何 调试 Homeposition 。 


四 、 实 验 前 准备 


1) 检查 机 器 人 电池 电量 是 否 充足 ， 用 万 用 表 测 量 电 池 放 电 接 头 两 端 电压 ， 知 小 于 6V， 
则 需要 更 换 电池 ， 并 对 原 有 电池 充电 。 
2) 检查 机 融 人 各 舵 机 连 线 ， 确 保 完好 无 损 ， 若 发 现 有 连 线 断 接 ， 或 者 刮 破 外 绝缘 皮 等 


现象 , 则 要 先进 行 简单 处 理 ， 如 重新 Er x— 
i 


接线 、 贴 绝缘 胶布 等 措施 。 

3) 检查 舵 机 连接 件 是 否 变 形 ， 
若 有 变形 ， 则 需 更 换 该 部 件 。 

4) 机 器 人 检查 完好 之 后 ， 确 保 
一 切 正常 才 可 开 电 ， 否 则 后 果 自 负 。 

5) 如 图 7-60 和 图 7-61 所 示 连 接 
无 线 收发 装置 ， 它 共有 两 条 连接 线 ， { e^ 
一 端 按照 图 示 方 式 连 接 ， 另 外 一 端 分 E A 
别 接 计 算 机 的 串口 1 和 USB 接口 ， 连 
接 好 之 后 则 指示 灯亮 ， 打 开 上 位 机 软 
fr, 界面 如 图 7-62 所 示 ， 如 图 7-63 
所 示 单 击 菜单 栏 “ 设 定 串 口 参 数 ”， FLTO0 AARE 
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弹出 如 图 7-64 所 示 界 面 ， 按 照 图 示 进 行 设置 ， 单 击 “OK”， 退 出 软件 并 重新 启动 。 启 动 软 
件 后 ,用 鼠标 拖 动 动作 数据 滑 块 中 的 任意 一 个 ， 则 该 装置 的 指示 灯 将 会 如 图 7-65 所 示 不 停 
闪烁 ， 说 明 反 应 连接 无 误 ， 运 行 良好 。 和 否则 ， 检 查 连 线 并 重新 连接 ， 直 到 正常 为 止 。 

3 


Z 


7-61 无线 发 射 装置 连接 方法 


"$ ROBCON?4motoür 
文件 ” 设 定 初始 位 置 ”动作 编排 设置 帮助 


速度 控制 组 号 m ID 
RB cicecseacscecs|p I [i27 


iw CHI 上 iw CH5 
iv CH? ijv cm 


iv CH3 lv CHT 


iV CH4 


iv CHS iv CH13 


v CH9 |? cia foo 


iv CHID jv CHi5 


w CHIL w ciie fao 


iv CHi2 (v CHIT EN 


EN | az | Me 
xi | 添加 | | 插入 | | 发 送 
序号 | DATA CH | CHT | CHS | CH3 | CH10 


* Ill 
当前 状态 AUE 
保存 | 配置 | me | 运行 | s |[ m ] 


7-62 上 位 机 软件 界面 


7m 
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器 


7-63 ”菜单 栏 示意 图 


TER 
4 


端口 设置 RZ FAE — due ”停止 位 "(T 
[comi ~| 6007| 8 ~| [non=] 1 ~ 


Cancel 


图 7-64 串口 设置 对 话 框 


7-65 ”无 线 发 射 装置 正常 运行 


Hi 
VR 


五 、 实 验 步骤 


实验 (一 ) 调试 并 存储 Homeposition 
1) 如 图 7-66 所 示 将 机 器 人 背部 面板 上 两 个 小 开关 同时 拨 到 图 示 位 置 ， 使 机 器 人 处 于 无 


AA 


" wufag ur apeu —————— « 


图 7-66 机 右 人 控制 电路 板 
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线 控制 (或 同时 拨 到 相反 位 置 并 将 主机 的 串口 线 接 到 电路 板 上 采取 有 线 方式 调节 )， 在 此 采 
用 无 线 方式 ， 打 开机 器 人 电源 ， 控 制 板 上 三 个 指示 灯 均 亮 。 

2) 清楚 掌握 各 舵 机 转动 角度 增 大 和 减 小 时 机 器 人 的 动作 变化 ,来 填写 表 74， 只 有 掌 
握 这 个 表 ， 才 能 自如 地 通过 上 位 机 控制 软件 来 调节 机 器 人 的 动作 。 注 意 我 们 都 以 从 背面 来 观 
察 机 器 人 的 角度 来 得 到 下 面 各 个 能 机 在 度数 变化 时 的 转动 方向 。 填 写 之 后 通过 上 位 机 程序 上 
的 滚动 条 来 验证 结果 。 

注意 : 在 表 7-4 中 的 第 Gp 个 与 第 5 个 艇 机 的 栏 中 填 入 方向 为 “前 后 ”, 第 2、3、6、7 个 
舵 机 的 栏 中 填 入 方向 为 “内 外 ”， 第 4 个 与 第 8、13 个 舵 机 的 栏 中 填 入 方向 为 “左右 ” ,第 
9、10、11、14、15、16 个 舵 机 的 栏 中 填 入 的 方向 为 “前 后 ”， 第 12 个 与 第 17 个 舵 机 的 栏 
中 填 和 信 “ 顺 逆 时 针 转 动 "。 请 同学 们 认真 填写 ， 之 后 通过 上 位 机 程序 上 的 深 动 条 来 验证 结 
Fo 


表 7-4 各 舵 机 度数 变化 的 转动 方向 (从 背面 看 各 舱 机 变化 情况 ) 


ft 
机 1 2 3 4 b 6 F 8 9 10 11 12 13 14 15 16 17 
l 
K X 小 头 X X 小 fi fit 康 中 m ft ii 膝 RO 
S S 由 部 VU WW EH X £X X X X * 关 £X X* X 
增 | 后 向 [i] 左 前 向 [8] 市 Rs Tq 节 节 节 节 节 d 
x 里 里 1x PH 外 外 左 前 后 后 顺 左 后 前 前 顺 
大 摆 B ix E H 1x 1x " 
转 转 
大 大 小 头 大 小 i Hi F3 "n ER E [3 jE RO 
H 臂 臂 部 D: B B X X X X 关 关 关 关 关 x 
X4 | 前 向 [H] d 后 向 [8] ji 节 3 T 节 节 d 节 节 节 
外 外 E E E E A 后 前 前 > — d 前 后 后 3X 
小 x H B 1x Al H 摆 ES x a 
3) 根据 图 7-67 NLA EÐLI ÉD, 38 
过 上 位 机 控制 软件 的 滑 块 来 调节 舵 机 的 度数 
(图 7-67 中 机 器 人 各 舵 机 编号 与 图 7-68 动作 [sH H>] 
数据 滑 块 一 一 对 应 ， 例 如 1 号 对 应 与 CH1， 
依次 类 比 下 去 )， 调 试 出 机 器 人 初始 位 置 
Homeposition 。 
调试 机 器 人 初始 位 置 的 方法 : [5] 
QD 机 器 人 电路 板 初 次 打开 电源 ， 各 舵 机 
处 于 保持 状态 ， 因 此 打开 电源 之 前 可 先 手 动 
调整 各 舵 机 位 置 让 其 有 较 大 的 活动 范围 ， 避 [^] [s] 
免 上 电 之 后 调整 初始 位 置 时 发 生 堵 转 。 


@) 读 取 参 考 初 始 位 置 文件 (后 级 名 为 
. hos) ， 并 设置 为 现 有 机 器 人 的 初始 位 置 ， 此 图 7-67 ”从 机 器 人 背面 观察 的 舵 机 标号 
时 机 器 人 有 了 粗略 的 初始 位 置 ， 由 于 机 峰 人 机 械 结构 的 差异 ， 需 要 对 其 进行 微调 。 

色调 整 髋 关节 左右 方向 移动 的 舵 机 (8 号 和 13 号 ) ， 使 得 两 条 腿 平行 且 为 竖 直 方向 ， 同 
时 注意 两 条 腿 中 间 有 5 mm 左右 的 间隙， 避免 在 做 动作 时 出 现 摩 氛 。 


je cH la0 «| ^| déc ao 4 " 
zm s al + Wcm [B a , 
| iv aa w «| }| wor lo 4 + 
| v cm po al + 

| v cie Bo al El > moo al F H 
| v om an «| + M CHi4 90 — «4 k 
| iv cmo fao - «| + W CHIS 90 — «4 k 
| F= ciri po 1 + W CHIB 90 4 r 
| m cnz po «| + 区 cur 90 4 k 

图 7-68 ”动作 数据 滑 块 


(调整 躁 关 节 前 后 转动 的 舵 机 (11 号 和 16 号 )， 使 其 与 脚底 板 垂直 ， 接 着 调整 膝 关节 
HEDL (10 号 和 15 号 )， 使 其 与 中 关节 舵 机 两 舵 盘 连 线 与 脚底 板 垂直 ， 依 次 向 上 调整 膝 关 节 
和 髋 关机 前 后 方向 转动 的 舵 机 (9 号 和 14 号 ) ， 最 终 使 得 以 上 3 个 舵 机 ， 再 加 上 肩 部 能 机 
(1 号 和 5 号) ， 总 共 4 个 能 机 的 舵 盘 在 一 条 直线 上 ， 并 且 确 保 与 脚底 板 垂直 。 

COVER RIS CUL (3 号 和 7 号 ) ， 使 手臂 伸 直 成 一 条 直线 ， 调 节 肩 关节 两 对 舵 机 (1 
号 和 2 号 、5 号 和 6 号) 使 手臂 为 竖 直 方向 下 垂 ， 调 整 头 部 能 机， 使 其 处 于 正视 位 置 并 能 
右 各 摆动 90°。 

4) 最 后 ， 观 察 整个 机 需 人 成 立正 姿势 ， 既 不 前 作 也 不 后 仰 ， 平 稳 站 立 ， 手 臂 下 垂 ， 左 
右 对 称 ， 则 机 器 人 初始 位 置 调试 成 功 。 

5) 如 图 7-69 所 示 ， 单 击 “ 设 定 初始 位 置 一 设 定 机 器 人 的 初始 位 置 ”， 将 机 器 人 的 初始 
位 置 设 定 成 刚刚 调试 完成 的 Homeposition 。 


dr Eea 设置 ”帮助 一 


[ uw 。 保存 初始 位 置 煞 据 Í HE 
本 读 职 初始 位 置 数据 ET Ea [ea] 
设 定 村 器 人 的 初始 位 置 0 0 | [25:5] | 


图 7-69 ”菜单 栏 中 的 设 定 初始 位 置 项 


6) 单 击 “ 设 定 初始 位 置 一 保存 初始 位 置 数据 ”"， 设 置 好 文件 名 ,后 级 为 “. Hos”, 

实验 (二 ) ”设计 机 器 人 “招手 ”动作 

1) 单 击 “ 添 加 ”按钮 ， 将 Homeposition 数据 放置 在 数据 列表 框 中 ， 作 为 将 要 调试 的 招 
手动 作 的 开始 。 

2) 先 调 试 手臂 抬 起 动作 ， 拖 动 动作 数据 滑 块 中 的 CHI ( 对 应 于 机 器 人 的 工 号 能 机 ) ， 
使 机 器 人 手臂 上 抬 ， 与 竖 直方 向 成 30" 夹 角 ， 达 到 如 图 7-70 所 示 的 招手 的 动作 一 ， 然 后 单 击 
“添加 ”按钮 ， 这 时 数据 将 自动 添加 到 数据 列表 框 中 ， 位 置 位 于 第 2 行 ， 第 1 行为 Homeposi- 
tono 


3) 再 调试 招手 动作 ， 拖 动 动作 数据 滑 块 中 的 CH3, ， 使 机 器 人 前 臂 向 内 弯曲 成 120" ， 达 


139 


到 如 图 7-71 所 示 为 招手 的 动作 二 ， 然 后 再 单 击 “添加 ”按钮 ， 这 时 这 一 行 的 数据 应 该 再 添 
加 到 第 3 行 ， 于 是 已 经 完成 了 3 行动 作 数 据 的 调试 。 

4) 由 于 招手 这 个 动作 是 周期 重复 的 ， 可 以 将 招手 动作 一 与 招手 动作 二 作为 一 个 组 合 ， 
进行 周期 性 的 重复 ,例如 双击 数据 列表 框 的 第 2 行 ， 然 后 单 击 “添加 ” 则 生成 第 4 行动 作 ， 
双击 第 3 行 ， 然 后 添加 为 第 5 行 ， 依 次 周期 性 的 重复 第 2 行 和 第 3 行动 作 。 

5) 重复 多 次 之 后 ， 即 可 做 出 最 后 一 行 的 数据 ， 调 试 机 器 人 的 动作 有 这 样 一 条 规则 : 
“任何 动作 的 第 1 行 和 最 后 一 行 都 要 是 Homeposition”。 因 此 最 后 需要 做 的 就 是 把 Homeposi- 
tion 的 数据 添加 到 最 后 一 行 。 双 击 数据 列表 框 的 第 一 组 Homeposition 数据 ， 这 样 该 行 的 数据 
都 显示 在 动作 数据 滑 块 上 ， 然 后 单 击 “ 添 加 ”按钮 ， 将 Homeposition 添加 到 列表 框 的 最 后 一 
行 ， 作 为 招手 动作 的 最 后 一 组 动作 。 

6) 动作 调试 完毕 后 ， 就 要 给 机 器 人 发 送 数据 了 。 如 图 7-72 所 示 对 操作 界面 中 的 “组 
号 ”进行 配置 ， 默 认为 0， 如果 不 是 一 套 动 作 要 更 改组 号 ， 以 免 覆 盖 已 有 动作 数据 。 接 着 如 
图 7-73 所 示 单 击 下 端的 “发 送 ” 按 钮 ， 将 已 调试 好 的 招手 动作 发 送 至 下 位 机 ， 出 现 对 话 框 
后 单 击 “ 确 定 ”， 之 后 单 击 “ 运 行 ”按钮 ( 同样 在 单 击 之 前 也 要 选择 相应 的 组 号 ) ， 机 器 人 
将 完成 招手 动作 。 


7-70 ”招手 动作 一 图 7-71 招手 动作 二 
UBLUCONZS — 
TF REMA ”动作 编排 设置 帮助 
速度 控制 姐 号 重复 ID 
HW e 952-9 lp |t |127 


图 7-72 ”组 号 配置 图 示 
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序号 | pata | srren | cm | cre | cus | cua | cre | cre | cur | cus | cue | cmo | 


$ * 
当前 状态 BETERI WAHE 
保存 | me [mS] 运行 | se | 顺序 | 退出 | 


图 7-73 ”发 送 数据 图 示 


7) 修改 动作 的 速度 ， 例 如 将 速度 改 为 6 或 者 7 (默认 为 4) ， 按 上 述 步骤 重新 调试 一 遍 
招手 动作 ， 观 察 不 同 速度 对 机 器 人 动作 的 影响 。 

实验 (三 ) 设计 机 器 人 “ 蹲 下 扩 胸 ”动作 

1) 单 击 “ 添 加 ”按钮 ， 将 Homeposition 数据 放置 在 数据 列表 框 中 ， 作 为 将 要 调试 的 蹲 
下 扩 胸 动作 的 开始 。 

2) 先 调试 机 器 人 下 蹲 动 作 。 手 持 机 器 人 腰部 ， 拖 动 动作 数据 滑 块 中 的 CH11 和 CH16 
(对 应 机 器 人 中 关节 11 号 和 16 号 两 舵 机 ) ， 使 两 脚 平 面 平 行 ， 且 使 双 腿 与 两 脚 平 面 成 45" 夹 
fa; 再 拖 动 CH15 和 CH10 ， 使 膝 关 节 15 号 和 10 号 两 能 机 与 脚 平面 垂 直 ; 进一步 拖 动 CH14 
和 CH9 ， 使 本 来 向 后 倾斜 的 上 半身 挺 直 ， 也 就 是 与 脚 平面 垂直 。 到 此 整个 足下 动作 完成 ， 
单 击 “ 添 加 ”， 成 为 第 2 行 数据 。 在 此 应 注意 重心 问题 ， 若 太 前 倾 则 机 器 人 会 倒 下 ; 若 后 仰 
则 机 器 人 就 不 美观 。 

3) 接着 调试 机 器 人 扩 胸 动作 ， 该 动作 只 用 改变 了 用 膊 的 舵 机 转动 角度 ， 而 下 半身 仍 保 
持原 有 姿态 。 拖 动 CH1 和 CH5 ， 使 双 臂 向 前 平 举 ， 接 着 拖 动 CH3 和 CH7， 使 前 臂 向 内 弯 
曲 ， 两 个 肘 关 节 成 120°*， 到 此 扩 胸 动作 第 1 步 完 成 ， 添 加 为 第 3 行动 作 。 

4) 第 4 行 的 动作 是 扩 胸 的 第 2 步 ， 拖 动 CH2 和 CH6 ,使 上 辟 与 肩 成 120° 夹 角 ， 添 加 
为 第 4 行动 作 。 

5) 第 5 行 的 动作 是 扩 胸 的 第 3 步 ， 即 拖 动 CH2 、CH3、CH6、CH7 ， 将 双 臂 打开 成 水 
平一 线 ， 添 加 为 第 S 行动 作 ， 而 腿 部 舵 机 转动 角度 没有 改变 。 到 此 整个 扩 胸 动作 完成 。 

6) 从 第 6 行 开始 ， 各 行 都 作 是 对 第 3、4、5 行 扩 胸 动 作 的 周期 重复 。 例 如 ， 双 击 数据 
dp UM M cce M E E 
双击 第 五 行 添加 为 第 8 行 。 类 似 多 次 重复 ， 生 成 第 9、10 、11 行 等 。 

7) 当做 完 扩 胸 运 动 之 后 ， 机 器 人 放下 双 臂 ， 人 这 与 第 2 行 的 下 
蹲 动作 相同 ， 双 击 数 据 列表 框 的 第 2 行 ， 单 击 “ 添 加 ”按钮 ， 生 成 新 的 一 行动 作 。 

8) 最 后 一 行 仍然 是 Homeposition， 双 击 第 1 行 ， 单 击 “ 添 加 ”按钮 ， 生 成 最 后 一 行 ， 
这 样 所 有 的 动作 都 完成 了 。 

9) 为 了 检验 动作 的 好 坏 ， 需 要 先进 行 单 步 检验 ， 首 先 机 器 人 上 电 ， 连 接 好 串口 ， 将 刚 
才 得 到 的 蹲 下 扩 胸 的 数据 ， 从 头 到 尾 ， 双 击 每 一 行 ， 每 当 双 击 该 行 时 ， 机 器 人 就 会 实时 地 做 
出 相应 的 动作 。 
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10) 当 单 步 检 验 都 通过 时 ， 我 们 再 将 整个 动作 完整 地 发 送 到 下 位 机 。 方 法 与 实验 二 招 
手动 作 中 图 7-74 相同 。 


文件 路 径 | 浏览 


序号 | para | sezzp | chi | cHe | cus | cra | chs | cre | cmr | cuo | cma | cio | 


图 7-74 


六 、 思 考题 


1. 请 列 出 用 上 位 机 控制 软件 的 滚动 条 进行 简单 动作 调试 的 优 缺 点 。 

答 : 当 用 上 位 机 控制 软件 的 深 动 条 进行 简单 动作 调试 时 ， 

优点 : 调试 方法 简单 易 行 ， 不 需要 具有 复杂 的 技术 和 编程 知识 ， 也 可 对 机 带 人 进行 动作 
操作 ， 适 用 于 各 个 年 龄 段 的 用 户 。 在 机 器 人 已 有 动作 的 前 提 下 ， 可 采用 临 侈 法 ,一步 一 步调 
出 ， 使 得 新 的 机 器 人 也 具有 同样 的 动作 ， 简 单方 便 。 

缺点 : 效率 不 高 ， 所 有 的 动作 数据 要 逐 行 写 人 。 精 确 度 不 够 ， 因 为 这 种 方法 大 部 分 是 通 
过 观察 体会 ， 难 免 会 受到 主观 因素 和 环境 因素 的 限制 ， 导 致 动作 不 够 规范 。 特 别 是 如 :“ 行 
走 ”“ 上 楼 梯 ” 等 精确 度 要 求 很 高 的 动作 ， 用 该 方法 实现 难度 较 大 。 

2. 我 们 有 1-7 共 七 个 速度 ， 哪 个 速度 舵 机 速度 是 最 快 的 ? 具体 调试 动作 时 ， 根 据 什么 
选取 合适 的 速度 位 ? 

答 : 我 们 有 1 ~7 共 七 个 速度 ，7 号 速度 是 速度 最 快 的 。 反 之 ,1 号 速度 是 速度 最 慢 的 。 
那么 ，4 号 速度 是 我 们 默认 的 普通 速度 。 

具体 调试 动作 时 ， 要 根据 具体 动作 的 情况 来 决定 速度 的 大 小 。 如 果 编 写 的 动作 是 普通 动 
作 ， 对 稳定 性 要 求 不 高 时 可 以 选择 4 号 普通 速度 , 或 5 号 及 6 号 的 高 速度 ， 这 样机 带 人 的 动 
作 速 度 加 快 ， 增 加 了 机 天 人 动作 的 美感 。 对 稳定 性 要 求 很 好 时 ， 可 以 选择 2 号 或 1 号 低速 
度 ， 来 保证 动作 的 顺利 进行 。 总 而 言 之 ， 视 具体 动作 的 具体 要 求 ， 选 择 合适 的 速度 。 

3. 上 位 机 控制 软件 中 “添加 ”和 “插入 ”按钮 的 作用 有 何 区 别 ? 

答 : 如 图 7-74 所 示 ， 添 加 按钮 的 作用 是 将 滚动 条 当前 显示 的 数据 ， 添 加 到 列表 框 的 最 
后 一 行 ， 知 再 添加 ， 就 会 添加 到 刚才 的 那 行 的 下 一 行 ， 简 而 言 之 ， 添 加 按钮 永远 将 数据 加 到 
最 后 一 行 。 插入 按钮 的 作用 是 将 深 动 条 当前 显示 的 数据 ， 插 入 到 列表 框 光标 所 停 的 那 一 行 的 
前 一 行 ， 数据 列表 框 光标 所 停 的 那 一 行 可 以 通过 单 击 鼠 标 左 键 来 选择 ， 注 意 不 要 用 鼠标 双 
击 ， 如 有 果 双 击 的 话 ， 动 作 数 据 滑 块 的 就 会 同步 更 新 为 数据 列表 框 中 选中 的 哪 一 行 的 数据 ， 如 
果 正 在 保持 良好 通信 时 ， 则 会 执行 该 行动 作 。 

4. 为 什么 在 调动 作 时 ， 要 先 保证 单 步 运行 顺利 ， 再 将 数据 发 送 到 下 位 机 ， 进 行 整 体 


Di 
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行 。 如 果 跳 过 单 步 运行 ， 直 接 整 体 发 送 和 运行 ,会 有 什么 后 果 ? 

答 : 如 果 跳 过 单 步 运行 ， 当 然 可 以 直接 整体 发 送 和 运行 。 但 是 带 来 的 结果 都 不 是 我 们 所 
预料 的 那样 ， 由 于 对 于 动作 本 身 ， 一 个 连续 的 动作 都 是 由 各 个 静态 的 动作 组 成 ， 如 果 单 步 的 
某 个 动作 不 是 很 稳定 ， 试 问 整体 动作 一 起 运行 怎么 会 成 功 呢 。 

所 以 我 们 规定 在 调动 作 时 ， 除 一 些 极其 简单 动作 之 外 ， 都 要 先 保证 单 步 运行 顺利 ， 再 将 
数据 发 送 到 下 位 机 ， 进 行 整 体 的 数据 运行 。 这 样 才能 保证 动作 的 稳定 ， 但 这 样 也 不 是 充分 
的 ， 还 要 看 连贯 的 动作 是 否 顺利 进行 。 这 里 要 指出 的 是 :“ 一 般 来 计 ， 单 步 运行 不 稳定 ， 连 
续 整 体 运行 一 定 不 稳定 ; 但 单 步 运行 稳定 ， 连 续 整 体 运行 也 不 一 定 稳定 。” 因为 这 里 涉及 单 
步 动作 衔接 的 问题 ， 就 好 比 两 个 没有 关联 的 动作 ， 每 个 都 通过 了 单 步 运行 ， 但 整体 运行 一 定 
不 成 功 ， 因 为 它们 没有 衔接 。 所 以 在 单 步 运行 之 后 ， 还 要 考虑 动作 衔接 的 问题 ， 这 样 才能 
证 我 们 所 调试 出 的 动作 在 整体 运行 时 达到 万 无 一 失 的 效果 。 


实验 六 ”动作 数据 编程 实验 


一 、 实 验 目的 


1) 进一步 熟悉 上 位 机 软件 对 类 人 双 足 步行 机 器 人 的 控制 。 
2) 掌握 机 器 人 的 动作 数据 得 来 的 方法 以 及 镜像 法 的 思想 。 
3) 巩固 学 生 C ++ 编程 的 能 


二 、 实 验 设备 


PC 一 台 CRE VC 程序 ， 双 足 步行 机 器 人 上 位 机 控制 软件 ， 机 器 人 动作 数据 文件 ) ,无 
线 通 信 模 块 / 串 口 通信 线 ， 类 人 双 足 步行 机 器 人 一 台 ， 电 源 〈7.4V 锂电 池 ) ， 电 池 充 电 设备 
一 套 。 


三 、 实 验 原理 与 说 明 


当 我 们 在 编排 机 絮 人 动作 的 时 候 ， 经 常会 发 现 一 些 动 作 是 和 前 面 所 做 过 的 动作 有 对 称 的 
关系 ， 比 如 : 当 我 们 编排 机 器 人 上 楼 梯 的 动作 ， 如 果 在 我 们 已 经 成 功 地 完成 机 器 人 用 右 脚 踏 
上 楼 梯 的 第 一 个 台阶 的 基础 上 ， 我 们 就 可 以 用 镜像 法 来 精巧 地 得 到 对 称 的 动作 数据 。 由 于 下 
一 个 动作 肯定 是 要 让 机 器 人 在 右 脚 的 支撑 下 ， 伸 出 左 脚 踏 上 第 二 个 台阶 ， 这 样 的 动作 就 是 完 
全 地 与 前 面 一 个 动作 相对 称 ， 我 们 就 可 以 利用 镜像 法 ， 计 算 并 调试 出 动作 数据 。 

下 面 介绍 一 下 镜像 法 : 

对 于 两 个 动作 ， 如 果 左 右 完全 对 称 ( 第 一 个 动作 左边 的 形态 与 第 二 个 动作 右边 的 形态 
完全 对 称 ， 第 二 个 动作 就 好 像 是 第 一 个 动作 在 镜子 中 的 镜像 ， 故 称 此 法 为 镜像 法 ) ， 则 只 需 
先 调 通 一 个 动作 即 可 。 对 于 另 一 个 动作 ， 利 用 镜像 法 就 可 调 出 。 这 里 需要 注意 的 是 前 后 动作 
是 否 对 称 ， 都 是 以 Homeposition 的 动作 作为 参照 。 

当 了 解 到 镜像 法 的 原理 之 后 ， 我 们 所 要 做 的 就 是 找 出 左右 舵 机 的 对 应 关系 ， 这 在 我 们 上 
次 的 舵 机 调试 的 实验 课 上 已 经 得 到 了 ， 这 里 我 们 就 可 以 直接 运用 。 

当然 ， 即 使 我 们 了 解 了 能 机 的 镜像 对 应 关系 ， 也 知道 如 何 改 前 面 的 动作 数据 成 为 新 的 动 
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作 数 据 ， 但 如 果 在 动作 特别 复杂 ， 数 据 特别 长 的 条 件 下 ， 我 们 的 工作 量 难免 就 要 大 很 多 ,为 
了 提高 效率 ， 我 们 可 以 考虑 编写 一 个 简单 的 C ++ 程序 ， 来 实现 对 新 的 动作 数据 的 计算 。 

最 后 将 我 们 所 得 到 的 镜像 的 动作 数据 存放 起 来 ， 并 用 双 足 步行 机 器 人 上 位 机 控制 软件 来 
发 送 这 些 数据 ， 机 器 人 顺利 完成 动作 ， 方 可 达到 要 求 。 


四 、 实 验 步 又 


本 实验 是 利用 VC 软件 平台 ， 编 写 镜 像 法 程序 ， 在 给 出 机 器 人 招 左手 的 第 一 个 动作 的 前 
提 下 ， 通 过 镜像 法 完成 机 器 人 招 右手 的 第 二 个 动作 。 

1) 首先 在 实验 前 要 清楚 哪 两 个 号 的 舵 机 互相 对 称 ， 这 是 要 做 镜像 法 的 前 提 。 

2) 清楚 掌握 各 舵 机 转动 角度 增 大 和 减 小 时 机 器 人 的 动作 变化 ， 这 里 由 于 我 们 在 上 次 的 
舵 机 调试 的 实验 课 里 已 经 得 到 了 结果 ， 见 表 7-5。 同 时 注意 都 以 背面 观察 机 器 人 来 得 到 相应 
各 个 舵 机 的 转动 方向 (从 背面 看 各 舵 机 变化 情况 )。 
表 7-5 各 舵 机 镜像 对 应 关系 表 


对 应 | 9L [1 2 3 8 9 10 Ig 12 


HEBEL |5 6 7 18 14 15 16 17 


关系 am 


3) AEE PRAE BU BE BOE LAS Z5 OBL BS PE s Z, Redi o n] EASE 8 LEA 
左右 对 称 动作 时 ， 各 个 对 应 的 舵 机 所 转 的 角度 的 关系 ， 从 而 可 以 为 写 镜像 法 程序 打 好 基础 。 
通过 表 74 与 表 7-5 可 以 了 解 到 ， 当 机 器 人 拾 左手 时 ， 菜 号 舵 机 转动 了 一 个 角度 ; 然后 机 咒 
人 复位 ， 之 后 再 抬 右 手 且 姿势 刚好 与 左手 所 抬 的 高 度 一 样 时 ， 镜 像 对 应 的 舵 机 转动 了 相同 的 
角度 ， 只 是 存在 正 负 号 的 问题 。 请 同学 们 将 所 有 两 两 对 应 的 舵 机 都 通过 上 位 机 控制 机 器 人 ， 
来 得 到 镜像 对 应 的 舵 机 转动 角度 正 负 号 的 关系 ， 然 后 填 人 表 7-6， 因 为 如 果 弄 错 一 个 正 负 号 
的 话 ， 结 果 就 大 相 径 庭 了 〈 在 表 中 填 人 舵 机 转动 角度 的 正 负 号 ， 其 中 ， 正 号 表示 舵 机 角度 
增 大 ， 负 号 表示 舵 机 角度 减 小 ) 。 


表 7-6 ”左右 对 称 动作 时 各 镜像 舵 机 转角 度 正 负 号 对 应 关系 表 


ns 能 1 2 3 8 9 10 11 12 
右 动 机 

作对 [站 

称 时 | og 

舵 机 

t5 Ud 

Ts 机 5 6 7 13 14 15 16 17 
度数 

正 负 号 

关系 fi 


4) 这 样 我 们 的 准备 工作 大 致 就 完成 了 。 一 套 完整 的 镜像 动作 以 Homeposition 开始 ， 此 
时 舵 机 的 转动 角度 为 Ho 最 终 达 到 的 动作 状态 所 对 应 的 舵 机 转动 角度 为 A; 中 间 过 渡 过 程 中 
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每 一 个 动作 状态 所 对 应 的 舵 机 转动 角度 为 RR。 请 同学 们 将 三 者 的 关系 填 入 机 器 人 动作 时 的 度 
数 公式 : 

+ = (7-1) 

5) 由 公式 (7-1) 来 推导 公 vk 02). AR (12) 已 知 机 器 人 实际 动作 以 后 ， 最 终 达 到 

的 原 像 舵 机 转动 角度 AT (8 个 舵 机 的 度数 ) 与 开始 动作 时 原 像 舵 机 的 Homeposition 转动 角度 

H1 (8 个 舵 机 的 度数 ) ， 机 器 人 做 对 称 动 作 后 的 镜像 对 应 舵 机 的 转动 角度 A2 (另外 8 个 舵 机 的 

度数 ) 与 开始 动作 时 镜像 舵 机 的 Homeposition 转动 角度 H2 (另外 8 个 舵 机 的 度数 ) 四 者 的 关 

系 ， 请 同学 们 将 四 者 的 关系 填 人 机 器 人 动作 对 称 时 前 后 度数 之 间 的 对 应 关系 式 : 

一 = - (7-2) 

之 后 我 们 就 得 到 重要 的 式 (7-2) WEE, HAEA GUAMEOSEPRISE UD UP: 2/1 ff BE 18] BR R 
关系 式 : 


A2 = + = (7-3) 

6) 下 面 我 们 开始 利用 VC 软件 平台 来 编写 镜像 法 函数 。 主 要 思想 就 是 在 已 经 给 定 的 动 
作 数 据 的 条 件 下 ， 利 用 公式 (7-3) 计算 出 对 称 的 动作 数据 。 这 个 计算 通过 编写 函数 来 实现 ， 
避免 每 行 数据 用 手 算 的 工作 量 ， 达 到 提高 效率 的 作用 。 我 们 在 这 里 要 求 同 学 利用 C ++ 函数 ， 
直接 在 VC 里 生成 C ++ 源 文 件 ， 而 无 须 利 用 MFC。 如 图 7-75 所 示 。 


a 
文件 | 工程 | 工作 区 | 其 它 文档 | 

(g]Active Server Page NH c 
Élmmayric 
'&3| Bitmap File | t] 


E CIC++ Header File 
E]C* Source File! 
|B Cursor File 文件 
回 HTML Page 
Lico n File 

gae re 
zn e Scri 


ript CE: x 
Resource Template |CADocuments and Settings Adm = 
B SQL Script File 

E Text kie 


um 


图 7-75 ”创建 C++ 源 文件 界面 


7) 直接 生成 C ++ 文件 ， 其 中 文件 名 随意 起 ， 之 后 在 源 文件 中 进行 C ++ 编程， 主要 是 
利用 函数 实现 动作 数据 的 计算 。 这 里 不 用 子 函 数 ， 只 利用 main 函数 实现 其 功能 就 可 以 。 由 
于 我 们 利用 C ++ 的 输入 输出 流 ， 所 以 要 加 入 <iostream. h > 头 文件 。 如 图 7-76 所 示 。 

在 编写 镜像 法 程序 前 ， 首 先 我 们 要 填写 两 个 表 。 打 开 上 位 机 软件 ， 在 给 定 的 机 器 人 动作 
数据 文件 中 调 出 该 台 机 器 人 的 初始 位 置 。 将 机 需 人 在 初始 位 置 时 各 舵 机 的 转动 角度 值 填 人 表 
7-7 和 表 7-8。 
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void maini} 


1 
H 


Hinclude Xiestream.h» — 


图 7-76 ”操作 界面 


表 7-7 ”机 器 人 初始 位 置 时 各 舵 机 的 角度 值 


县 机 号 

- 1 2 3 8 9 10 11 12 
转动 角度 

HI 

R78 ”机 器 人 初始 位 置 时 各 舵 机 的 角度 值 
舵 机 号 

-~ 5 6 7 13 14 15 16 17 
转动 角度 

H2 


E NE SEE ILL ga 


#include < iostream. h > 


void main ( ) 


| 


int a,b,c,d,e,f,g,h; 
cout << "请 输入 各 舵 机 起 始 度数 " «« endl ; 


cout <<" 1/5 !'; 
cin >> ai 

cout << "2/6:"; 
cin >>b; 

cout << "3/7:"; 
cin >c; 

cout << "8/13:"; 
cin >d; 

cout << "9/14:"; 
cin >> e€; 


cout << " 10/15:"; 


// eV Ra 
// 用 户 输入 该 舵 机 的 度数 
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cin >>f; 

cout ««"11/16;" ; 

cin >> g; 

cout << "12/17:"; 

cin >>h; 

a=(H1[1] -H2[5] -a); // 利 用 公式 (5-5$)A2 2 H1 + H2 - Al 其 中 HIl 
[1] 和 H2[1] 分 别 是 对 应 的 两 个 Homeposition 

b-(HI[2] + H2[6] - b); 

c -(HI[3] +H2[7] -c); 

d-(HI[8] -H2|13] -d); 

e-(HI[9] -H2[14] -e); 

f-(HI[10] + H2(15] -f); 

g-(HI[11] + H2[16] -g); 

h=(H1[12] +H2[17] - hb); 


int data[ 8] = [a,b,c,d,e,f,g,h] ; // 定 义 数 组 
int 1=8; 
for(i=0;i<8;i++) // 保 证 算 过 的 舵 机 度数 在 1 ~179 之 间 


| 
if( data| i] <1) 
data[i] 21; 
if( data[ 1] » 179) 
data[ i] 2179; 
| 
cout << "经 换算 后 各 舵 机 角度 为 :" << endl; 
cout << "5/1:"; // REDUSE 
cout << data[ 0 | << endl; // 将 算出 的 舵 机 度数 显示 出 
cout ««"6/2;" ; 


cout << data[ 1 | << endl; 
cout << "7/3," ; 
«« endl ; 


cout «« data 


" 


cout << " 13/ 


2] 

8;"; 

cout << data[ 3] << endl; 
cout << "14/9; 

cout << data[ 4 | << endl; 
cout << "15/10:"; 

cout << data[ 5] << endl; 
cout << "16/11:"; 

cout << data[ 6 | << endl; 


cout ««"17/12;" ; 


t 
9 
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cout << data| 7 | << endl; 


| 
MI ggg NE SEE LLL LL Ll :^nPnWMMM 


程序 备注 : 

HI [i] 代表 H1 的 第 i 号 舵 机 的 转动 角度 ; H2 [j] 代表 H2 的 第 j 号 舵 机 的 转动 角度 。 

上 面 所 列 的 函数 需 运 行 两 次 才能 得 到 对 称 动作 的 完整 数据 。 例 如 : 运行 第 一 次 时 先 利用 
对 称 动作 前 的 1、2、3、8、9、10、11、12 号 舵 机 度数 来 算出 对 称 动 作 后 的 5、6、7 、13、 
14, 15, 16, 17 号 舵 机 度数 ， 再 运行 一 次 利用 对 称 动作 前 的 5S、6、7 、13、14、15 16, 17 
号 舵 机 度数 算出 对 称 动作 后 的 1、2、3、8、9 、10 、11 、12 号 舵 机 度数 。 

8) 在 main 函数 里 编写 对 称 动作 数据 转化 的 角度 计算 ， 其 中 函数 的 重要 部 分 就 是 利用 式 
(7-3) 的 推论 。 在 这 里 ， 我 们 已 经 给 同学 们 一 些 已 经 存在 的 动作 数据 ， 这 个 数据 是 机 器 人 招 
手 的 动作 ， 但 只 是 其 中 左手 招手 的 动作 ， 这 里 要 求 同 学 们 利用 冰 数 得 到 右手 招手 的 动作 。 知 
函数 编写 成 功 ， 我 们 立即 将 编写 好 的 VC 源 代码 直接 生成 出 相应 的 工程 ， 然 后 应 该 出 现 图 7- 
77 所 示 的 界面 。 


图 7-77 原 像 及 镜像 舵 机 角度 转换 界面 


9) 在 上 位 机 软件 中 调 出 机 器 人 左手 招手 动作 ， 并 在 动作 数据 列表 框 当 中 显示 出 。 把 数 
据 列 表 中 的 第 2 fi chl, ch2, ch3, ch8, ch9, chlO, chll, chl2 8 个 舵 机 的 数据 ， 在 图 
7-77 所 示 界 面 “ 请 输入 各 艇 机 起 始 度数 :” 部 分 中 ， 填 人 原 像 舵 机 的 起 始 度数 ， 然 后 按 回 
车 ， 运 行程 序 。 其 中 ， 图 7-78 实例 中 的 “1/5” 代 表 这 个 初始 位 置 既 可 以 先 规定 为 1 号 舵 机 
的 度数 ， 也 可 以 规定 为 5 号 舵 机 的 上 度数， 因此 我 们 规定 在 界面 中 “请 输入 各 舵 机 起 始 度 
数 :” 的 部 分 ， 在 “/ ”前 面 的 数字 为 要 输入 起 始 角度 的 能 机 号 ， 对 其 输入 角度 值 即 可 , E 
到 全 部 8 台 原 像 能 机 起 始 角度 都 输入 完 ， 才 可 输出 结果 ， 如 图 7-78 界面 中 的 “经 换算 后 各 
舵 机 角度 为 :” 部 分 。 在 此 部 分 中 “/” 前 面 的 数字 号 表示 镜像 舵 机 的 转动 角度 值 。 直 到 全 
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部 8 台 镜 像 舵 机 的 角度 值 都 输出 显示 为 止 。 之 后 再 运行 一 次 程序 ， 在 界面 中 “请 输入 各 舵 
机 起 始 度数 ”的 部 分 ， 输 入 “Z” 后 面 的 数字 号 的 舵 机 转动 角度 ， 对 应 地 在 界面 中 的 “经 换 
算 后 各 舵 机 角度 为 :” 部 分 ， 输 出 的 结果 也 是 对 应 “/ ”后 面 的 数字 号 的 能 机 应 当 转 动 的 角 
度 。 在 此 ， 由 于 动作 2 的 数据 另外 8 行 都 是 保持 在 初始 位 置 没 动 ， 因 此 就 不 用 再 通过 镜像 也 
数 来 计算 了 ， 因 为 即使 计算 了 ， 得 到 的 8 行 镜像 数据 组 (由 前 八 行 的 原 像 舵 机 角度 计算 出 
来 后 8 行 的 镜像 舵 机 角度 ， 就 称 之 为 镜像 数据 组 ) 也 还 都 是 初始 位 置 。 


[Press any key to continue 


图 7-78 数据 计算 后 显示 的 界面 


10) 如 图 7-78 所 示 ， 由 前 8 行 的 原 像 舵 机 角度 计算 出 来 后 8 行 的 镜像 能 机 角度 ， 并 记 
录 下 这 8 个 镜像 舵 机 角度 ， 称 之 为 动作 2 的 镜像 数据 组 。 再 回 到 步骤 9 中 数据 列表 框 第 3 
行 ， 按 照 生 成 动作 2 的 镜像 数据 组 的 方法 ,生成 动作 3 的 镜像 数据 组 。 通 过 观察 上 位 机 的 动 
作 数 据 文件 ， 我 们 可 以 发 现 ， 以 后 的 第 4 行 和 第 5 行 以 及 第 6 行 和 第 7 行动 作 其 实 就 是 动作 
2 和 动作 3 的 简单 重复 ， 因 此 没有 必要 再 计算 了 。 下 面 我 们 再 双击 上 位 机 的 第 8 行动 作 数 
据 ， 然 后 单 击 添加 按钮 ， 连 续 单 击 8 下 ， 向 动作 数据 文件 再 添加 进去 8 行动 作 数据 ， 这 些 数 
据 每 一 行 都 是 机 器 人 的 初始 位 置 ， 下 面 我 们 来 修改 这 些 数据 。 首 先 双 击 第 10 行 的 动作 数据 ， 
通过 拉动 ch 、ch6 、ch7 、chl13 、ch14 chl5, chl6, chl7 的 角度 条 ， 把 我 们 前 面 记 下 的 动 
TE 2 的 镜像 数据 组 改 到 相应 的 舵 机 上 ， 然 后 单 击 修改 ， 即 完成 了 第 10 行动 作 数 据 的 调整 。 
再 通过 同样 的 方法 把 记 下 的 动作 3 的 镜像 数据 组 修改 到 第 11 行动 作 数据 中 。 根 据 前 面 招手 
动作 采用 的 简单 重复 办 法 ， 我们 分 别 把 第 10 行 和 第 11 行 的 动作 数据 修改 到 第 12 行 和 第 1 
行 ， 以 及 第 14 行 和 第 15 行 ， 最 后 一 行 保 持 初 始 位 置 不 变 。 这 时 我 们 就 得 到 一 个 完整 的 招 了 
的 数据 ， 如 图 7-79 所 示 。 

11) 运行 上 位 机 程序 ， 对 机 器 人 进行 操作 ， 若 得 到 的 数据 正确 ， 则 我 们 能 看 到 机 器 人 
能 够 成 功 的 用 右手 向 我 们 打招呼 ， 这 就 是 我 们 需要 得 到 的 动作 ， 它 正好 是 和 机 需 人 的 招 左手 
的 动作 是 对 称 的 ， 这 样 就 达到 了 实验 要 求 。 

最 后 感 兴趣 的 同学 可 以 继续 做 下 去 ， 可 以 让 机 器 人 多 实现 几 个 对 称 的 动作 。 


tt 


Bm w 
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w 设 定 初始 位 置 设置 E 


速度 控制 组 号 重复 ID 
k cCciceCcsceacscsccs||p 1 icd 
[CHI |30 4 上 v CH 90 1 上 
W cH jao a 上 |" cHe 90 4 + 
| W cH 30 1 k W CHT 90 a + 
| [Iw cH4 (90 4 上 
| j- cH |90 4 r W CHI3 80 a k 
| i" CHI |90 4 r W CHI4 80 — 4 k 
| cmoo  « ;| roso a + 
| W cijo a ^| jwcmeje 4« r 
| W cHiz [90 4 b iw cui 30 4 k 
dies Sr 添加 di^. TRIES 清空 AE 

交 件 路 径 EwanahIRDS2006\Z1 数 据 \ 动 作 : ”浏览 保存 关闭 串口 | 
序号 | DATA | seen | cii | cHe | eus | cr | cie | cHe | cHr | cue | eie | cas 
11 DATA 2 107 11 9T 80 100 119 100 90 32 49 
12 DATA 2 113 34 ST 90 100 170 100 90 18 49 
13 DATA 2 113 88 9T 80 100 179 100 90 48 T6 
14 DATA 2 15 11 9T 80 171 173 9% 91 86 100 
15 DATA 2 T8 53 ST 90 179 1T5 9 (91 135 108 
16 DATA 2 86 65 93 90 T8 173 36 101 121 %0 
1T DATA 2 86 14 S93 0 T3 150 98 101 112 %0 
1A TATA F BP iz] a3 an TA 115 an BR 117» an he 
€ > 
当前 状态 AEE EE 发 送 


运行 复位 顺序 退出 


图 7-79 ”数据 插入 到 上 位 机 后 的 界面 


五 、 思 考题 


1. 我 们 一 共有 几 种 方法 可 以 得 到 双 足 步行 机 右 人 的 动作 数据 ? 

答 : (1) 最 普通 的 方式 ， 就 是 利用 上 位 机 里 面 的 滚动 条 手动 调 出 动作 数据 ， 该 方法 效率 
不 高 ， 但 简单 易 行 。 

(2) 通过 仿真 来 得 到 动作 数据 ， 这 种 方法 完全 抛 开机 器 人 本 体 ， 直 接 在 虚拟 的 方针 平台 
上 来 对 机 如 人 进行 数据 调制 ， 得 到 机 屁 人 的 动作 数据 。 

(3) 通过 编程 来 得 到 动作 数据 ， 这 种 方法 往往 是 当 机 器 人 的 动作 有 取 巧 之 处 时 ， 我 们 可 
以 知道 下 一 个 动作 与 前 面 的 某 个 动作 有 一 定 的 对 应 关系 ， 比 如 周期 性 、 对 称 性 等 。 该 方法 效 
率 高 ,但 有 一 定 的 难度 。 

(4) 通过 行为 数据 库 来 得 到 机 器 人 的 动作 数据 ， 行 为 数据 库 里 装 满 了 机 器 人 的 各 个 动作 
的 元 素 ， 合 理 的 组 合 编排 即 可 得 出 机 器 人 的 动作 数据 ， 该 方法 效率 高 ， 且 简单 易 行 ， 是 现在 
比较 流行 的 方法 。 
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2. 除了 上 楼 梯 ， 还 有 那些 动作 可 以 利用 镜像 法 来 编排 动作 ? 

答 : 如 果 熟 悉 了 镜像 法 的 原理 ， 不 难 发 现 上 只 要 编排 的 机 器 人 动作 里 面 有 对 称 的 关系 ， 都 
可 以 利用 镜像 法 来 得 到 。 比 如 : 向 左 侧 滚 翻 如 果 已 经 得 到 了 ， 那 么 向 右 侧 滚 翻 就 可 以 用 镜像 
法 得 到 ; 还 有 有 关 前 进 时 往 前 迈 的 左右 腿 都 是 对 称 的 关系 ; 还 有 一 些 舞蹈 动作 的 编排 ， 需 要 
对 称 时 ， 都 可 以 利用 镜像 法 来 得 到 。 

3. 除了 镜像 法 ， 你 还 能 总 结 出 什么 快捷 简便 的 方法 来 得 到 数据 ? 

A: (1) 周期 法 ， 当 机 器 人 的 动作 是 周期 性 反复 的 话 ， 就 没有 必要 一 帧 一 帧 地 编写 ， 可 
以 完全 编写 好 一 个 完整 周期 后 ， 即 可 利用 周期 法 实现 想 要 的 动作 。 

(2) 倒序 法 ,在 机 器 人 已 有 的 动作 前 提 下 ， 我 们 可 以 利用 倒序 法 来 得 到 一 些 新 的 动作 。 
例如 : 将 机 絮 人 的 前 走 ， 一 帧 一 帧 地 倒 写 ， 就 可 以 得 到 机 器 人 的 后 走 ; 将 机 器 人 向 左 侧 翻 ， 
一 帧 一 帧 地 倒 写 ， 就 可 以 得 到 机 器 人 的 向 右 侧 翻 。 

(3) 文件 转化 法 ， 在 机 器 人 已 有 的 动作 的 前 提 下 ， 想 得 到 为 一 个 机 器 人 的 相同 动作 的 
数据 ， 可 以 利用 文件 转化 法 来 得 到 ， 但 需要 微调 一 下 ,计算 往往 会 出 现 一 两 度 的 偏差 。 

(4) 临 莫 法 ， 对 于 一 些 简单 的 动作 且 在 机 器 人 已 有 的 动作 的 前 提 下 ， 想 得 到 另 一 个 机 
器 人 的 相同 这 样 动 作 的 数据 ， 可 以 用 临 莫 法 ， 让 已 经 有 劲 作 的 机 器 人 做 “模特 ”， 一 帧 一 帧 
地 摆动 作 ， 让 其 他 机 器 人 学 习 动 作 ， 达 到 实现 动作 的 目的 。 


实验 七 ”上 位 机 编程 实验 


一 、 实 验 目的 


1) 掌握 Visual C ++ 开发 工具 的 基本 使 用 方法 。 
2) 了 解 和 掌握 Visual C++ 工具 编写 基于 MFC Windows 应 用 程序 的 方法 。 
3) 熟悉 和 掌握 几 种 控件 的 使 用 。 


二 、 实 验 设备 
PC 一 台 ( 装 有 Visual C ++), 
三 、 实 验 原 理 与 说 明 


在 本 实验 中 ， 我 们 将 通过 开发 一 个 基于 MFC 的 Windows 应 用 程序 ， 来 了 解 Visual C ++ 开 
发 对 话 框 程序 的 基本 方法 和 步骤 ， 为 进一步 开发 机 器 人 的 上 位 机 控制 程序 打 好 基础 。 这 个 程 
序 的 基本 功能 是 : 通过 滚动 条 控制 文本 框 显示 的 数值 。 

MFC 是 微软 开发 的 一 个 类 库 ， 它 提供 了 开发 Windows 应 用 程序 需要 的 基本 框架 ， 利 用 
它 可 以 极 大 地 方便 程序 员 开 发 Windows FE, MFC 以 其 强大 的 功能 和 灵活 的 编程 方式 成 为 
大 多 数 程序 开发 人 员 最 经 常 使 用 的 一 种 编程 方式 。 我 们 使 用 的 开发 工具 是 Visual C ++6. 0， 
用 这 个 微软 提供 的 集成 开发 环境 开发 对 话 框 类 型 的 应 用 程序 ， 只 需要 借助 它 提供 的 向 导 
就 可 以 方便 地 产生 一 个 对 话 框 程序 的 挫 形 ， 留 给 开发 人 员 的 工作 就 是 各 种 控件 的 使 用 。 
例如 在 本 实验 的 示例 程序 中 大 部 分 功能 实际 是 在 MFC 的 CWinApp 和 CDialog 等 基 类 中 完 
成 的 ， 在 编程 时 ， 只 需 在 派生 类 中 编写 少量 功能 代码 (这 在 下 面 的 内 容 中 会 得 到 验证 )， 
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C++ 人 允许 以 这 样 的 方式 借用 基 类 中 的 大 量 代码 而 无 须 复 制 代 码 。 应 用 程序 框架 负责 提供 
程序 的 结构 框架 ， 开 发 人 员 在 此 基础 上 为 其 添加 相应 的 实现 代码 ， 从 而 可 以 非常 方便 地 
完成 一 个 完整 的 应 用 程序 。 应 用 程序 框架 不 仅 定义 了 应 用 程序 的 结构 安排 , 实际 上 还 包 
含 了 更 多 的 C++ 基 类 。 

本 程序 中 用 到 的 其 他 控件 的 使 用 ， 如 文本 框 、 滚 动 条 等 ， 可 以 参考 相关 的 书籍 ， 这 方面 
的 书籍 很 多 ， 所 以 这 里 就 不 再 说 明了 。 


四 、 实 验 步 又 


1. 建立 一 个 基于 对 话 框 的 工程 

利用 Visual C ++ 的 向 导 建 立 一 个 基于 对 话 框 的 应 用 程序 ， 具 体操 作 是 文件 一 新 建 ， 
打开 新 建 对 话 框 ， 如 图 7-80 所 示 。 选 择 MFC AppWizard (exe), 设置 好 工程 名 和 路 径 ， 单 
击 确定 ， 就 进入 了 应 用 程序 向 导 ， 如 图 7-81 所 示 ， 按 照 提示 操作 就 生成 对 话 框 程 序 的 基本 
框架 。 一 般 情况 下 ， 我 们 采用 向 导 中 的 默认 设置 即 可 ， 不 需要 任何 修改 ， 所 以 直接 单 击 
“确定 ”及 “完成 ”就 生成 了 我 们 需要 的 工程 。 


文件 工程 | 工作 区 | 其 它 文 档 | 


.ATL COM AppWizard 工程 
Si]Cluster Resource Type Wizard TestP 
Custom AppMizard 


CE 位 置 : 
FAXIE LAOSHIEÉR SUBE . 


"Makefile 
ĝa MFC ActiveX Control'Wizard 
f| MFC AppWizard [dll] - 及 创建 新 工作 


di New Database Wizard 

ïi Utility Project 

3| Win32 Application 

Win32 Console Application 
|| Win32 Dynamic-Link Library 
X Win32 Static Library 


P 平 台 : 


wwwin32 


确定 结束 


图 7-80 新 建 工程 对 话 框 


FH 


2. 利用 资源 编辑 器 生成 “上 位 机 程序 实验 ”界面 

如 图 7-82 所 示 ， 我 们 应 该 在 窗 体 中 添加 这 些 控件 : 两 个 静态 文本 框 ， 一 个 可 编辑 文本 
框 ， 一 个 滚动 条 控件 。 完 成 这 些 操作 也 很 简单 ， 控 件 工具 栏 中 选择 相应 的 控件 ， 然 后 按 住 鼠 
标 左 键 拖 搜 即 可 完成 摆 放 控件 的 工作 。 

3. 设置 控件 属性 

在 资源 编辑 器 中 ， 选 中 相应 的 控件 ， 然 后 单 击 鼠标 右键 ， 选 择 “属性 ”， 如 图 7-83 所 
示 。 打 开 图 7-84 所 示 的 属性 设置 对 话 框 。 

设置 静态 文本 框 的 标题 分 别 是 : 舵 机 角度 和 舵 机 角度 控制 ， 设置 可 编辑 文本 框 的 ID 为 


152 


WFC AppFirard - Step | 


程序 类 型 ? 


上 你 喜爱 你 的 资源 使 


FREIER E] APPYWZCHS.DLL] 


器 


7-81 ”应 用 程序 向 导 


Static 


Static 


图 7-82 ”程序 界面 


IDC EDIT DSHOW; 设置 滚动 条 的 ID 为 IDC_ SCROLLBAR DCTRL。 其 他 属性 不 用 修改 ， 
采用 默认 的 设置 即 可 。 

4. 在 类 向 导 中 添加 变量 和 函数 

通过 菜单 “查看 一 类 向 导 ” 或 者 直接 用 快捷 键 “Cul + w” 打 开 类 向 导 ， 如 图 7-85 所 
示 。 选 择 “Member Variables” 标 签 ， 为 可 编辑 文本 框 和 滚动 条 添加 变量 ， 如 图 7-86、 
图 7-87 所 示 。m-DShow 的 类 别 选择 Value， 变 量 类 型 选择 int; m-DCtbl 的 类 别 选 择 Control, AE 
量 类 型 选择 CScrollBa. 在 MFC 中 ， 变 量 与 控件 之 间 通 过 一 定 的 映射 机 制 关 联 ， 我 们 通过 变量 
来 操纵 控件 的 行为 。 如 我 们 通过 m DShow 修改 文本 框 控件 显示 的 内 容 ; 通过 m_DCul 控制 
滚动 条 的 动作 。 


s mw 


EE 
Static 


Insert Active Control... 


Size to Content 


g Check Mnemonics 


起 rE 
Events... 
图 7-83 ”打开 属性 对 话 框 的 方法 
Text Properties 
9 ? General | Styles | Extended Styles | 
ID: IDC_STATIC ~ CO: 
v 3 显示 v Group H 帮助 ID 
Disabled Tab 停止 
a) 静态 文本 框 
Edit Properties 
Styles | Extended Styles | 
ID: IDC EDIT DSHOW - 
v 3 显示 


Group 
Disabled 


H 帮助 ID 
v Tab 停止 


b) 可 编辑 文本 框 


ID: 


Scroll Bar Propertres 
9 ? General | Styles | 
IDC | 


v 8 显示 


Disabled 


SCROLLBAR DCTRL 


下 


Group 


Tab 停止 


9) 滚动 条 


器 


7-84 各 个 控件 的 属性 对 话 和 


MI 
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Message Maps — Member Variables 


Project: 
TestP 


T 


EFC ClazssTizard 


Automation | ActiveX Events | Class Info | 


Class name: 


FA. ATestPATestPDIg.h, FA. ATestPATestPDIg.cpp 


Control IDs: 


IDC SCROLLBAR DCTRL 
IDCANCEL 
IDOK 


Description: 


Type 


CTestPDlg m 


Add Class... v 


Add Variable... 


Add Wember Variable 


图 7-85 


Member variable name: 


m DShow 


Category: 


Description: 


int with validation 


图 7-86 添加 变量 对 话 框 


下 面 打 开 Message Maps 标签 ， 


类 向 导 对 话 框 


出 


Add Wember Variable 


Member variable name: 
m DCtrl 

Category: 

Control 


Vari 


Description: 


map to CScrollbar member 


A 7-87 ”添加 变量 对 话 框 


OK 


Cancel 


出 


为 主 对 话 框 的 WM  HSCROLL 消息 添加 函数 ， 如 图 7-88 所 


示 。 这 样 ， 当 用 户 拖 动 滚动 条 时 ， 就 会 产生 WM HSCROLL 消息 ， 通 过 信息 映射 机 制 (MFC 
已 经 自动 为 我 们 做 好 这 个 映射 ) ， 程 序 就 会 调用 OnHSceroll 函数 。 下 一 步 我 们 将 把 控制 文本 框 


一 


击 “ 确 定 ”完成 所 用 的 设置 。 
5. 添加 自己 的 代码 


显示 的 代码 放 到 OnHScroll 函数 中 实现 ， 就 可 以 实现 拖 动 滚动 条 控制 文本 框 显 


示 的 目的 了 。 单 


找到 TestPDlg. cpp 文件 中 的 OnInitDialog 函数 ， 在 如 图 7-89 所 示 的 位 置 添加 如 下 代码 : 
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EFC ClassWirard 


Message Maps Member Variables | Automation | ActiveX Events | Class Info | 


Project: 
Testp 


FA. ATestPATe stPDIg.h. FA... ATestPiTestPDlg.cpp 


Object IDs: 


IDC EDIT DEHOwW 


IDC SCROLLEAR DCTRL 


IDCANCEL 
IDOK 


Member functions: 


V DoDataExchange 
W 


w OnlnitDialog DN_wM_INITDIALOG 
W OnPaint ON wWM PAINT 
W OnQueryDraglcon ON VM QUERYDRAGICON 


Description: Indicate 


Class name: Add Class... Y 
- CTestPDlg ud 


Messages: Delete Function 


WM DRAWITEM 
Wi HELPINFO 


WM INITDIALOG 
WM_KEYDOWN 
wM KEYUP 

WM KILLFOCUS 


s a click in a horizontal scroll bar 


m DShow = 90; 


图 7-88 ”类 向 导 对 话 框 一 添加 消息 函数 


m _ DCtrl. SetScrollRange( NMin, NMax) ; 
m DCtrl. SetScrollPos( (NMin + NMax)/2,TRUE) ; 


UpdateData ( FALSE) ; 


SetIcon(m hIcon, 
SetIcon(m hIcon, 


// 使 文本 框 显 示 为 m” DShow 的 值 90 


TRUE ) ; // Set big icon 
FALSE}; // Set small icon 


dë TODO: Add extra initialization here 


return TRUE; A 


return TRUE unless you set the focus to a control 


图 7-89 OnlnitDialog 函数 中 位 置 


OnIitDialog 函数 将 在 显 


示 对 话 框 之 前 调用 ， 完 成 一 些 初始 化 工作 。 如 上 面 的 代码 将 使 文 


本 框 显 示 为 909， 深 动 条 位 于 中 间 位 置 。 记 住 要 给 NMin NMax 进行 声明 ， 和 否则 程序 在 编译 的 时 


候 就 会 报错 。 
#define NMax 179 
#define NMin 1 


找到 TestPDlg. cpp 文件 中 的 OnHScroll 函数 ， 在 如 图 7-90 所 示 的 位 置 添加 如 下 代码 : 


switch( nSBCode) 
| 


case SB - THUMBTRACK. 
if( ( * pScrollBar) 22m - DCtrl ) | 


m — DShow 
break ; 


- nPos; ( * pScrollBar). SetScrollPos( m — DShow) ; break; | 


case SB LINERIGHT: 
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case SB PAGERIGHT: 
if( ( * pScrollBar) 22m _ DCtrl) | 
ifím DShow ++ > = NMax) 
m DShow = NMax;( * pScrollBar). SetScrollPos( m - DShow) ; 
break ; | 
break ; 
case SB LINELEFT: 
case SB PAGELEFT: 
if( ( * pScrollBar) 22m  DCtil) | 
ifím DShow- - <= NMin) 
m JDShow = NMin;( * pScrollBar). SetScrollPos(m | DShow) ; 
break; | 
break ; 


UpdateData ( false ) ; 
void CTestPD1g::ünHScroll(UINT nSsBCode, UIHT nPos, CScrollBarx pScrollBar) 


// TODO: Add your message handler code here and/or call default 


EDialog::ünHScroll(nSBCode, nPos, pScrollBar); 


图 7-90 | OnHScroll 函数 中 位 置 


6. 编译 、 构 建 并 执行 程序 
通过 菜单 : 编译 一 构建 ， 建 立 工程 ;编译 一 执行 ， 执 行 工 程 。 或 者 通过 工具 栏 进行 这 些 操 
作 ， 如 图 7-91 所 示 。 


ins M ~ LIestiilg.cpp 
1 h 
AR $ al EE 
]- 4$&OnHScroll 7 ~ 
-fir.Drauicnníx. n. m hiran: 


图 7-91 编译 工具 栏 


程序 运行 后 的 界面 如 图 7-92 所 示 ， 同 学 们 可 以 拖 动 滚动 条 看 看 文本 框 内 容 的 变化 。 


五 、 思 考题 

1. 用 自己 的 话 概 述 消 息 处 理 的 过 程 ? 

答 : 在 Window 操作 环境 下 ， 无 论 是 系统 产生 的 行为 或 用 户 运 行 应 用 程序 产生 的 行为 都 称 
事件 产生 的 消息 ， 消 息 处 理 函 数 处 理 消息 的 过 程 一 般 归纳 为 接收 消息 、 分 发 消息 、 人 处 理 消息 和 
用 户 交 互 。 


157 


EHAE : 


舵 机 角度 控制 1 


图 7-92 程序 界面 


2. 总 结 OnHScroll 函数 的 用 法 ? 
答 : 当 用 户 拖 动 滚动 条 时 ， 就 会 产生 WM HSCROLL 消息 ， 通 过 信息 映射 机 制 (MFC 已 
经 自动 为 我 们 做 好 这 个 映射 ) ， 程 序 就 会 调用 OnHScroll 函数 。 


实验 八 ” 双 足 步行 机 器 人 串 行 口 通信 实验 


一 、 实 验 目的 


1) 了 解 串口 通信 的 基本 原理 。 

2) 了 解 双 足 步 行 机 器 人 读 取 初始 位 置 时 的 通信 协议 格式 。 

3) 了 解 VC 串口 通信 控件 的 应 用 。 

4) 学 习 机 器 人 的 上 位 机 和 下 位 机 是 如 何 实现 交互 从 而 控制 机 器 人 的 。 


二 、 实 验 设备 


有 串口 的 PC 一 台 CRA VC 编程 环境 及 机 器 人 上 位 机 软件 ) 、 双 足 机 器 人 一 台 、 串 口 通信 
线 一 条 o 


三 、 实 验 原理 与 说 明 


串口 通信 的 基本 原理 及 VC 串口 编程 ; 

l. 串 行 通信 的 基本 原理 

所 谓 “ 串 行 通信 ”是 指 外 设 和 计算 机 间 使 用 一 根 数据 信号 线 ， 数 据 在 一 根 数据 信号 线 上 
按 位 进行 传输 ， 每 一 位 数据 都 占据 一 个 固定 的 时 间 长 度 。 当 数据 从 CPU 经 过 串 行 端口 发 送出 
去 时 ， 字 节 数 据 转 换 为 串 行 的 二 进 制 位 。 在 接收 数据 时 ， 串 行 的 二 进 制 位 被 转换 为 字 节 数据 。 
在 Windows 环境 (Windows NT, Win98, Windows2000) 下 ， 串 口 是 系 统 资源 的 一 部 分 。 应 用 
程序 要 使 用 串口 进行 通信 ， 必 须 在 使 用 之 前 向 操作 系统 提出 资源 申请 要 求 〈 打 开 串 口 ) ， 通 信 
完成 后 必须 释放 资源 (关闭 串口 )。 

2. 串口 信号 线 的 接 法 

一 个 完整 的 RS -232C 接口 有 22 根 线 ， 采 用 标准 的 25 世 插 头 座 (或 者 9 芯 插 头 座 ) 25 
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芯 和 9 芯 的 主要 信号 线 相同 。 以 下 的 介绍 是 以 25 4585 RS -232C 为 例 。 

(1) 主要 信号 线 定义 

2 脚 : 发 送 数据 TXD; 

3 脚 : 接收 数据 RXD 
AJ. 请 求 发 送 RTS 

5 脚 : 清除 发 送 CIS; 

6 脚 : 数据 设备 就 绪 DSR; 
20 脚 : 数据 终端 就 绪 DTR; 
8 脚 : 数据 载波 检测 DCD; 
1 JA. 保护 地 ，; 
7 脚 : 信号 地 。 

(2) 电气 特性 ”数据 传输 速率 最 大 可 到 20kbit/s， 最 大 距离 仪 15m。 

(3) 接口 的 典型 应 用 ”大 多 数 计算 机 应 用 系统 与 智能 单元 之 间 只 需 使 用 3 ~5 根 信和 号 线 即 
可 工作 。 这 时 ， 除 了 TXD, RXD 以 外 ， 还 需 使 用 RIS, CIS, DCD, DTR, DSR 等 信号 线 ( 当 
然 ， 在 程序 中 也 需要 对 相应 的 信号 线 进行 设置 ) 。 

以 上 接 法 ， 在 设计 程序 时 ， 直 接 进 行 数据 的 接收 和 发 送 就 可 以 了 ， 不 需要 对 信号 线 的 状态 
进行 判断 或 设置 (如果 应 用 的 场合 需要 使 用 握手 信号 等 ,需要 对 相应 的 信号 线 的 状态 进行 监测 
或 设置 ) 。 

3. Æ MFC 下 的 32 位 串口 应 用 程序 

32 位 串口 通信 程序 可 以 用 两 种 方法 实现 : 利用 ActiveX 控件 ; 使 用 API 通信 函数 。 使 用 
ActiveX 控件 ， 程 序 实现 非常 简单 ， 结 构 清 晰 ， 缺 点 是 欠 灵 活 ; 使 用 API AA K AAA k 
基本 上 相反 。 

在 此 ， 我 们 是 用 MSComm 控件 实现 。 我 们 上 位 机 所 要 作 的 工作 是 利用 VC 里 的 MSComm 
控件 的 方法 来 进行 双向 的 单线 程 串 口 通信 。 

这 牵扯 到 数据 协议 的 制定 和 编程 的 实现 。 上 位 机 与 下 位 机 的 通信 方式 有 有 线 和 无 线 两 种 ， 
有 线 方式 已 经 比较 成 熟 ， 无 线 方式 需要 对 单 向 的 传输 增加 握手 协议 ， 使 下 位 机 可 以 向 上 位 机 反 
馈 信息 。 由 于 不 管 是 采用 有 线 还 是 无 线 方式 ， 上 位 机 都 是 通过 串口 与 下 位 机 通信 ， 所 以 编程 部 
分 只 需要 根据 串口 协议 的 变化 做 出 相应 的 调整 就 可 以 了 。 


四 、 实 验 步 又 


1. 了 解 双 足 机 器 人 的 通信 协议 格式 

数据 包 格 式 : Oxff, 0xfe + 数据 帧 + 校 验 和 。 

数据 帧 格式 : 地 址 码 + 控制 命令 + 0x00，…，0x00。 

控制 命令 : 0x01: 主机 读 回 Homeposition 数据 。 

机 器 人 返回 数据 ， 地 址 码 + 数据 标签 + 相关 参数 (4 字 节 ) + Homeposition (17 字 节 ) 。 

数据 标签 : 0x00: Homeposition 数据 (主机 读 Homeposition 时 ) 。 

2. 编写 串口 监视 软件 

1) 创建 工程 ， 单 击 Pile 一 New， 产 生 如 图 7-93 所 示 窗 口 ， 在 左边 选择 “MFC AppWizard 
[exe]”， 右 面 “Project name” 处 填写 项 目 名 称 为 : CommShow， 选 择 保存 路 径 ， 单 击 下 一 步 。 
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S| File Edit Yiew Insert Project Build Layout Tools Window Help PII-IE: 
a sug DEE Afm ReecvD | a Pc ru PALEB TAAR 
alz “| 
SCommTest resources 
9 Dialog i 
jIDD ABOUTBOX zm E3 | 
Sip scowuresr | | :| 一 ax] 
“C leon 1| Files Projects | Workspaces | Other Documents 
=- C String Table 了 
*-CiVersion -| LHATL COM AppWizard Project name: 
| 本 cster Resource Type Wizard CommShewl 
E {Custom App Wizard 
:| Database Project e, 
I| BhDevStudio Add-in Wizard Ducem € 
2| IŚ Extended Stored Proc Wizard CaProgram Files\Microsoft Visus E| 
-| @ISAPI Extension Wizard 
-| i]Makefile 
:| &EMFC ActiveX ControlWizard 
E £ MFC AppWizard {dll} ® Create new workspace 
EBMFC AppWizard (exe) C Add to current workspace 
S New Database Wizard x 
Ñi Utility Project 
"8| Win32 Application 
—Win32 Console Application Le 
|] Win32 Dynamic-Link Library 
5] Win32 Static Library 
Platforms: 
vWin32 
4 
3 OK Cancel 
lereating brouse info file... E 
StonmTest.exe - B error(s), 8 varning(s) 
[r Build { Debug X Find in Files 1 X[*| 人 
Ready PUR Lx Sac s E E 00 I 235x169 
IIT goo" | ScomTest -Mier | (SB MISI Library - 0 W) 文档 1 - Microso.. E. E a 20:22 
— i e — 
LLUT 
图 7-93 工程 设置 
将 项 目 设置 为 Di 如 图 所 示 ， 然 后 单 击 完成 
2) 将 项 目 设 置 为 Dialog based， 如 图 7-94 所 示 ， 然 后 完成 。 


EFC 


AppWizard 一 Step 1 


What type of application would you li 


Application 


C Single document 


C Multiple documents 


What language would you like your r 


az 


ke to create? 


esources in? 


| 中 文 [ 


国 ] [APPWZCHS.DLL) 


图 


Finish 


Cancel 


j 程 序 向 导 步 又 


图 7-94 MFC 应 


3) 在 Dialog 资源 中 加 入 如 下 控件 : 添加 Static box 和 EditBox 控件 各 两 个 ，Botton 控件 一 


个 ， 并 通过 在 控件 上 单 击 右键 ,选择 


ton 为 “发 送 显 示 ” 和 “接收 显示 ”; 将 Botton 控件 的 Caption 改 为 “发 送 ” 


“Properties” 进行 控件 属性 设置 ， 改 变 Staticbox 的 Cap- 


; EditBox 控件 处 
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设置 它们 的 ID 分 别 为 IDC — EDITI 和 IDC-EDIT2， 并 在 属性 窗口 的 “Style” 选项 卡 中 ， 作 如 
图 7-95 所 示 设 置 。 


dit Properties 


-H Y General | 


Align text: 四 Horizontal scroll iv Border 
Left "| v Auto HScroll No hide selection Uppercase 
v Multiline iv Vertical scroll QEM convert | Lowercase 


Number . Auto VScroll Want return iv Read-only 


t 
= 
im 


图 7-95  EditBox 控件 属性 框 
全 部 设置 完成 后 如 图 7-96 所 示 。 


^5 Commshow - Microsoft Visual C++ - [Commshow.rc - IDD COMMSHOW DIALOG (Dralog)] 


Sine Edit view Insert Project Bu 村 Layout Tools Window Help =la] B x| 
站 e Hg Es (D, RIP GA len BIET 
CCommShowDlg EAT class members] » || $ CCommShuowDlg bo A~ [S El 
PE 
E-e - Tm 
+ Dialog == 
*- [jlcon Be d Es] 
*-[3 String Table abl 
*-[] Version p a 
@ 


&DETeHE»X[ib-E 


] & 


B 

[un] 
Eg 
TE 
H 
国 
Ela 


m 


" 3Class... |4] Resnou...| El FileView ET 


到 P 


[+h Build Debug X Find in Files 1 Y Find in Files 2 Y Results] «| | 回国 


* &H 
- Sup 4 E 
Ready E po SA 


7-96 ”控件 设置 完成 后 界面 
4) 单 击 Project—Add To Project— Components and Controls, WEK NJI 口 通信 控件 。 
5) 查找 范围 选择 Registered ActiveX Controls, TE Registered ActiveX Controls XIX F, FR 
到 Microsoft Communications Control 控件 ， 单 击 “Insert” 按 钮 如 图 7-97 所 示 ， 弹 出 如 图 所 示 对 
话 框 ， 单 击 “OK”， 之 后 单 击 “ 关 闭 ”。 


6) 将 通信 榨 件 图 拖 动 ， 添 加 到 对 话 框 中 ， 并 单 击 右键 ， 选 择 Properties 项 ， 设 置 如 图 7- 
98 所 示 。 
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oa T 
[E] File Edit View Insert Project Build Tools Window Help -lex 
23 eug DAT |m ReceiveData Ja $gBXtuesgvSeESXGoEE::cm$ 

PE Ell HalogtComsSherllg::IDD, pParent) leas 
+ 回 CommShow resources 77 YYAFN_DATA_MAP = 
H | 
BEGIN MESSAGE HüP(CComnShowDlq, CDialoq) 
IIAAAFN | z 
ON WM SY | Confirm Classes 
ON WH PA 


ou ww gu Choose a component to insert into your project The checked class[es] will be generated from 
OFX [eted heive Controls =] the ActiveX Control. Click on a class name to 
END Message 查找 范围 四 : | S Registered Activer Controls 7| BÍ browse or edit its attributes. 
ppp [Microsoft Animation Control, version 5.0 (SP2) 
FF CConmShou WMicrosoft BarCode Control 9.0 vi 
Bijmicroscft Chart Control, version 5.0 (DLEDB) 
Common Dialog Control, version 5.0 (SPA 


Communications Control, version 6.0 


BOOL CComnsh 
H 


CDialog: EMerosoft Coolbar Control, version 8.0 
< 


LL qu [lierosoft Communications Control, ver: 


77 IDHA Microsoft Comm Control 6.0 
RSSERT(( Class name: Base class: 
RSSERT(I [CMSComm —  CWnd 
Chenu P Header file: 
if (pSys 
h MSComm.h 
Path to control: 
CStr " " 
stra CAWINDOWSisystem320MSCOMM32.0CX Maple on qM 


if ( MSComm.cpp 


lam; i i EEEE a 


m Clas... | Ë Res... 
E 


E 


[rh Build Debug X Find in Files 1 XI4 | ai 


Ready Ln 64, Col 2 
gev- um Lace MAEI mere. TCR DEEE 


K 7-97 ”添加 串口 通信 控件 到 基本 工具 栏 中 


pu 


G CommShow 一 Nicrosoft Visual CH - [ComaShow.rc — IDD CONKESHO 


| DIALOG (Dialog)] 


(E kile Edit Yiew Insert Project Build Layout Tools Window Help 


a sud X c|n- DA RE Gm ctrTabSheet EINER SU ooEeoEegesccg 
习习 TI 
+ C CommShow resources * 
E 
J B XBR: [Edit 
A m B 
EI: $ m 
-| i BRER: fn 中 rg 
ud lid 
As i 
AE & Microsoft Communications Control, version 6.0 Properties jx) A E 
EI ai 
EI HP General | Control | Butters | Hardware | Al | ms 
EIS 
E: 发 送 
EI. 1D: [IDC MSCOMMI| E e B 
四 1 
gl e ES Ee PEE 
| Disabled iv Tab stop 
* 5ClassView | $5] Resource View | S] FileView 
E z 
[Dr Build (Debug X Find in Files 1 M4*| | s 


E 213 I 25x25 


ET BOO teg os 


图 7-98 设置 串口 通信 控件 ID 号 
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7) 在 Dialog 资源 中 单 击 右键 ， 选 择 ClassWizard ， 为 各 资源 加 入 变量 如 图 7-99. 所 示 。 
通过 “MFC ClassWizard” 对 话 框 上 面 的 选项 卡 ， 选 择 Member Variables, ， 通 过 双击 控件 的 


ID 弹出 Add Member Variable 对 话 框 来 添加 控件 的 变量 ， 如 图 7-100 所 示 。 


区 CommShow 一 Nicrosoft Visual C++ - [CommShow.rc — IDD CONNSHOW DIALOG (Dialozg)] 


max 


E] Zile Edit Vies Insert Project Build Layout Tools Window Help -la| x] 
à eug B2- DAR Gm ReceiveData T] a Bx! 5| 06, 2eBmeGoEY usc) 
EE 1 
+ C CommShow resources * 
" ia 
3 pern: [Bui mem 
: [k ER) 
= Aa abl 
1 $ Cot Eo 
3 Ba Cory rel 
了 @ peste. 国力 
E 接收 显示 : pe Insert ActiveX Control. | 
3 = 8 
: ° 
E LII 
: Et 
P S? Check Mnemonics e H | 
A Classfirara ab p 
Events. ES 王 
ET properties eE 
* 3 Clas... | Res... 
3 
x| a 
[Tr Build { Debug X Find in Files 1 &| «| [| 
Edits the application classes and ties resources to code to nas Wi 178x71 
mv Qo." CE) USDE Library - 0. id) bs 1 - Microso.. - Buceo 3 20:25 
rmm 
E VLIZ . B y EL 
7-90 选择 ClassWizard 进入 类 向 导 
Lr] 
M] File Edit Yiew Insert Project Build Layout Tools Window Help -l| x] 
E cg tE R DAR [m ctrTabSheet EEUESESMIEEMLEITET-ET TI IPCECESPEREL 
ixi r 
+ C CommShow resources * 
Message Maps Member Variables | Automation | ActiveX Events | Class Info | k g 
Project: Class name: PEERSEEFUR ED | 2 abi 
CommShow - = E ma 
Add Nember Variable Elanie... Re 
C3... XCommShowiCommShowDlg.h. x 
Control IDs: Member variable name: OK = 
E B 
IDC BUTTONT m sSend| $m 
IDC EDITI Cancel 
IDC EDIT2 Category: 4e 5g 
IDC MSCOMMI Valuc zl Te 
Variable type: a 5 
CString - B 
v E 
Description: Description: 
CString with length validation 
* 3ClassView | $5] Resource View [sit 
i OK Cancel 
8 
[>] Build { Debug X Find in Files 1 MT «| | + 站 


Ready 


ETT 


TN PUTEM W) EU (1219. dec. 
7-100 为 各 控件 添加 成 


员 变 


-E 
Di HR 


Lo 85,15 i 219x62 


rega BERE T- on 
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添加 后 的 结果 如 图 7-101 所 示 ， 之 后 单 击 “OK” 退 出 。 


EFC ClassWizard £3 


Message Maps Member Variables | Automation AdiveX Events | Class Info. | 


Praject: Class name: Add Class.. ~ 


CommShow =| |CCommShowDlg z 1 
Add Variable... || 
CA. ACommShowtCommShaowDlg.h. C3... ACommShawtlg.cpp 一 一 一 | 
Control IDs: Type Member Delete Variable. | | 
IDC BUTTONI | 
IDC EDITI CString m sSend | 
iDC EDIT? CString m_sReceive | 
JIDE MSCOMMIT CMSComm m Comm | 


Description: 


OK Cancel 


7-101 ”完成 添加 全 部 成 员 变 量 后 界面 

8) 在 MFC ClassWizard 界面 中 ， 选 择 Message Maps 选项 卡 ， 单 击 IDC - MSCOMMI 和 Mes- 
sages 框 中 的 OnComm， 当 两 条 都 被 选中 时 ， 单 击 右 面 的 “Add Function” 按 钮 , 准备 加 入 消息 
响应 函数 OnComm ( ) ， 如 图 7-102 所 示 。 


MFC ClassWizard 


器 


Message Maps | Member Yariables | Automation | ActiveX Events | Class Info | 


Project: Class name: Add Class... v 


[CommShow CCommShowDlg bd 

Add Function... 
CA. ACommShavACommShowDlg.h, CA... XCommShowDlg.cpp pus we imu usd 
Object IDs: Messages: 


CCommShowDlg PTT 
IDC BUTTONI , EdtCode | 
IDC, EDITI 
IDC EDIT2 


Member functions: 

V DoDataExchange 

w OnlnitDialog ON WM INITDIALOG 

W' OnPaint ON WM PAINT 

W OnQueryDraglcon ON 9M QUERYDRAGICON 
W OnSysCommand ON Wd SYSCOMMAND 


Description: Occurs whenever the value of the CommEvent property changes. 


7-102 ”准备 添加 消息 响应 函数 On Comm. () 
弹出 如 图 7-103 所 示 对 话 框 ， 进 行 如 下 设置 后 ， 单 击 “OK” 按 钮 。 


Memberfunction name: 


OnComm 
Cancel 


Message: OnComm 
Object ID: IDC. MSCOMMI 


7403 ”设置 成 员 函 数 名 
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9) 双击 “Member functions” 框 中 的 OnComm 函数 (ILAI 7-104) ， 在 弹出 的 CommShowD- 
lg. cpp 文档 〈 见 图 7-105) 的 OnComm 函数 中 加 入 如 下 代码 。 


NEC ClassWizard (2 ES 


Message Maps | Member Variables | Automation | ActiveX Events | Class Info | 


Project: Class name: Add Class... v 


CommsShow -| ICCommShowDlg ”| 

CA... ACommSh owACommShowDlg.h. CA... XCommShowDlg.cpp l Add Function | 
Object IDs: Messages: Delete Function | 
(CCommShowDlg nomm — : 

IDC EDITI Etoile 

|IDC EDIT2 

IDC. MSCOMMI 


Member functions: 


V DoDataExchange 

E OnComm ON IDC MSCOMMT:OnComm 
W OnlnitDialog ON VH INITDIALOG 

(W OnPaint ON vi PAINT 

W OnQueryDraglcon ON vM QUERYDRAGICON v 


Description: Occurs whenever the value of the CommEvent property changes. 


OK Cancel 


图 7-104 WR KAŽ OnComm () 设置 完成 


// Draw the icon 
dc.DrawIcon(x, y, m hIcon); am 

H 

else 

t 
CDialog::0nPaint{}); 

H 

H 


// The system calls this to obtain the cursor to display while the user drags 
// the minimized windou. 
HCURSOÜR GCCommShouD1g::ünQueryDragIcon() 
i 
return (HCURSÜR) m hIcon; 
H 


BEGIN EUEHTSIHK HüP(GCommShouDlg, CDialog) 
//A4REFX EVENTSINK HAP(CCommShowDlg) 
/* üntomm x/ 
/A£/T$REX EUEHTSIHMH HAP 
EHD EUENTSIHK HAP() 


void ECamnShoub1g : :ünComn( ) 
{ 


// TODO: Add your control notification handler code here 


H 


IER | 


图 7-105 “弹出 的 CommShowDlg. cpp 文档 
void CCommShowDlg: : OnComm( ) 
| 
// 'TODO: Add your control notification handler code here 
VARIANT variant inp; 
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COleSafeArray safearray _ inp; 

LONG len,k; 

BYTE rxdata[ 2048] ; //ix'& BYTE 数组 
CString strtemp ; 


ifím | Comm. GetCommEvent( ) ==2) 
| 
// 响 应 串口 接收 事件 的 代码 
variant _ inp =m Comm. Getlnput( ) ; // 读 缓冲 区 
safearray inp variant inp; //VARIANT 型 变量 转换 为 ColeSafeArray 型 变量 
len = safearray _ inp. GetOneDimSize( ) ; // 得 到 有 效 数据 长 度 
for(k 20;k «len;k ++) 
safearray | inp. GetElement ( &k , rxdata + k) ;// 转 换 为 BYTE 型 数组 
for(k 20;k «len;k ++ ) // 将 数组 转换 为 Cstring 型 变量 
| 
BYTE bt = * (char * ) (rxdata +k); // 字 符 型 
strtemp. Format("%x " ,bt); // 将 字符 送 入 临时 变量 strtemp 存放 
m sReceive + = strtemp ; // 加 入 接收 编辑 框 对 应 字符 串 
| 
m sReceive + =" \r\n"; 


UpdateData ( FALSE) ; // 更 新 编辑 框 内 容 


10) 在 BOOL CCommShowDlg:: OnInitDialog () 函数 的 // TODO: Add extra initialization 
here 代码 后 加 入 程序 初始 化 代码 ， 进 行 串口 初始 化 。 

// TODO: Add extra initialization here 

// 初 始 化 串口 

m Comm. SetCommPort(1) ; /选择 COMI 

m Comm. SetInputMode( 1) ; // 输 入 方式 为 二 进 制 方式 

m Comm. SetInBufferSize( 1024) ; /设置 输入 缓冲 区 大 小 

m Comm. SetOutBufferSize(512 ) ; // 设 置 输出 缓冲 区 大 小 

// 波 特 率 9600 ,无 校 验 ,8 个 数据 位 ,1 个 停止 位 

m Comm. SetSettings( "9600,n,8,1") ; 

if(! m Comm. GetPortOpen( ) ) 

m Comm. SetPortOpen( TRUE) ; /打开 串口 

// 参 数 1 表示 每 当 串 口 接收 缓冲 区 中 有 多 于 

// 或 等 于 16 个 字符 时 将 引发 一 个 接收 数据 的 OnComm 事件 

m Comm. SetRThreshold (25 ) ; 

m Comm. SetInputLen(0) ; // 设 置 当 前 接收 区 数据 长 度 为 0 
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m Comm. GetInput( ) ; // 先 预 读 缓冲 区 以 清除 残留 数据 
ZN 
11) 双击 “发 送 ”按钮 ， 添 加 发 送 函 数 : 双击 后 ， 在 弹出 的 对 话 框 中 单 击 “OK” 按 钮 ， 
之 后 进入 函数 内 加 入 代码 。 
void CCommShowDlg: : OnButtonl ( ) 
| 
unsigned char chTemp[26 ] ; 
chTemp|[0] =Oxff; 
chTemp| 1 ] 2 Oxfe; 
chTemp|2] 2127; 
chTemp[ 3 ] 20x01 ; // 读 Homeposition 
for(int i1=4;i <=24;i++) 
chTemp[ i] 20x00; 


// 校 验 和 

unsigned char sum =0; 
for (i =0;i <25;i ++ ) 
| 


sum + -chTemp[i]; 


| 


chTemp[25] = -sum; 

// 通 过 串口 发 送 数据 

CByteArray array; // 定 义 转换 的 数据 类 型 
array. RemoveAIl( ) ; // 1823 array 

array. SetSize(26) ; // 设 定 array 的 大 小 


for(i = 0; i < 26; i++) 
| 
array. SetAt(i, * (chTemp 4i) ); /给 array 赋值 
BYTE bt = * (char * ) (chTemp +i); // 字 符 型 
CString strtemp; 
strtemp. Format(" 96x " ,bt) ; // 将 字符 送 入 临时 变量 strtemp 存放 
m _sSend + =strtemp; // 加 入 接收 编辑 框 对 应 字符 串 
| 
m_sSend+ "Wn"; 
m Comm. SetOutput( COleVariant( array ) ) ; 
UpdateData( FALSE) ; 
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us 


12) 通过 依次 单 击 菜单 或 工具 栏 中 El 按钮， 进行 编译 并 执行 程序 。 将 程序 编译 并 
执行 之 后 界面 如 图 7-106 所 示 。 


e Comrmishow 


图 7-106 程序 编译 执行 结果 


3. 连接 好 机 器 人 

采用 有 线 方式 ， 机 器 人 背部 电路 板 上 两 个 模式 拨 码 开关 均 拨 到 下 方 ， 串 口 选择 COMI 控 
制 ， 单 击 “ 发 送 ”按钮 。 利 用 实验 步骤 1 中 的 预备 知识 并 通过 软件 观察 数据 的 格式 ， 了 解 上 位 
机 和 下 位 机 具体 是 如 何 利 用 串口 进行 通信 的 。 

1) 打开 编写 的 软件 。 

2) 单 击 “ 发 送 ”按钮 ， 通 过 软件 观察 数据 ， 如 图 7-107 所 示 。 


Ee Comathor 


ff fe TE 1 00 000000000000 


GRE RU E E 
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五 、 思 考题 


L 回顾 实验 过 程 中 ， 上 下 位 机 的 通信 过 程 ， 总 结 上 位 机 是 如 何 通过 串口 与 机 器 人 实现 通 


信和 的? 


答 : 通过 软件 上 下 的 显示 ， 可 以 看 出 上 位 机 先 发 出 了 机 器 人 控制 信息 ， 如 : 机 器 人 工作 状 


态 、 下 位 机 存储 的 动作 数据 组 号 、 数 据 帧 、 


舵 机 角度 及 校 验 等 信息 。 下 位 机 在 收 到 数据 后 验证 


校 验 和 ， 并 且 给 上 位 机 相应 的 反馈 。 由 此 ， 保 证 上 下 位 机 之 间 正 确 、 可 靠 的 通信 。 
2. 思考 使 用 多 线程 进行 上 下 位 机 同步 通信 的 意义 ? 
答 : 多 线程 提高 了 程序 执行 的 效率 ， 提 高 了 编程 的 灵活 性 。 在 串口 程序 中 ， 有 很 多 应 用 多 
线程 设计 的 地 方 ， 例 如 : 为 了 实现 串口 接收 的 事件 驱动 方式 ， 可 以 考虑 单独 建立 一 个 工作 线 
程 。 在 该 线程 中 循环 检测 串口 事件 ， 但 是 不 会 造成 程序 界面 的 假死 ; 在 使 用 多 个 串口 时 ， 也 可 
以 使 用 多 线程 编程 。 


实验 九 ZMP 实验 


一 、 实 验 目的 


1) 掌握 杆 件 位 姿 矩 阵 的 建立 方法 。 
2) THE ZMP 理论 及 其 在 机 器 人 控制 中 的 重要 意义 。 
3) 了 解 使 用 MATLAB 对 ZMP 理论 的 验证 做 出 仿真 。 


二 、 实 验 设备 
XUEPETTEUA A —f1. PC 一 台 (CRA MATLAB ， 上 位 机 控制 软件 ) 。 
三 、 实 验 原理 与 说 明 


1. ZMP 点 


计算 及 步行 稳定 条 件 


双 足 步行 机 器 人 研究 的 一 个 关键 问题 是 实现 其 稳定 的 行 
走 。 目 前 世界 上 大 多 数 双 足 步行 机 器 人 系统 都 采用 ZMP 作为 
稳定 行走 的 判 据 。ZMP 即 零 力矩 点 (Zero Moment Point) 的 


简称 ， 是 由 南 


斯 拉夫 学 者 Vukobratovic (简称 伍 氏 ) 提出 的 关 


于 步行 稳定 性 的 经 典 理论 ， 具 体 描述 为 : 指 重力 与 惯性 力 的 


合力 的 延 线 与 


力矩 为 零 ， 如 


也 面 的 交点 ， 在 该 点 处 ， 合 力 对 * THURU y 轴 的 
图 7-108 中 合力 下 与 地 面 的 焦点 就 是 ZMP 点 。 


这 个 ZMP 点 的 位 置 直接 影响 到 了 机 器 人 的 稳定 性 ， 即 机 器 人 


是 否 能 够 稳定 的 站 立 。 


双 足 步行 机 器 人 在 步行 过 程 中 机 体 的 ZMP 点 是 随时 变化 
的 ， 我们 将 ZMP 离 支 撑 面 边缘 的 最 短 距离 定义 为 稳定 裕 度 ， 
当 在 其 内 时 为 正 ， 是 稳定 的 ， 反 之 为 负 ， 是 不 稳定 的 。 

步行 机 器 人 在 步行 时 ， 作 用 在 其 上 的 外 力 为 重力 、 摩 控 


图 7-108 ”机 器 人 受 力 分 析 与 
ZMP 点 的 确定 


169 


力 和 惯性 力 。 按 行走 的 动态 平衡 理论 ，ZMP 点 的 规划 直接 影响 到 步行 机 器 人 的 稳定 性 、 补 偿 运 
动 的 大 小 、 关 节 了 驱动 力矩 的 大 小 ， 所 以 在 规划 时 应 在 保证 动态 平衡 、 行 走 稳定 的 前 提 下 ， 使 补 
偿 运 动 、 关 节 驱 动力 矩 尽量 减 小 ， 从 而 减 小 步行 机 副 人 的 能 量 消耗 ， 提 高 步行 效率 。 

根据 Vukobratov 提出 的 ZMP 理论 ， 当 支撑 脚 与 地 面 多 点 接触 时 ，ZMP 点 的 位 置 坐 标 为 


Xe = 之 n L— (7-4) 
A m; (Z. 十 g ) 
i=0 
00 n 00 
Èm (z +g )v, - Xm, (Y. +g )z 
Yme = ct " P 2 (7-5) 
Èm, (Z. +g) 


式 中 m 一 各 部 分 的 质量 ， 

X, Yi, Z 一 一 各 部 分 的 质心 。 
当 机 器 人 做 静态 步行 时 ,多 =X, =Y, -0 
所 以 有 ， 


(7-6) 


式 中 Xa Y, — —À8SUE BUS ARGUS IS] AS s s 

即 ， 双 足 机 器 人 的 质心 即 为 ZMP 点 。 因 此 只 要 使 重心 落 在 脚面 上 ， 就 可 保证 双 足 步行 
机 器 人 稳定 的 静态 步行 。 因 此 复杂 的 ZMP 点 求解 的 任务 变 成 了 求解 重心 点 的 任务 。 

2. 建立 连 杆 坐标 系 ， 确 定位 资 矩 阵 

双 足 步行 机 器 人 为 多 杆 系统 ， 两 杆 间 的 位 姿 矩 阵 是 求解 双 足 步行 机 器 人 各 个 质点 位 姿 矩 
阵 的 基础 。 两 杆 间 的 位 姿 矩 阵 取决 于 两 杆 之 间 的 结构 参数 、 运 动 形式 和 运动 参数 ， 以 及 这 些 
参数 按照 不 同 顺序 建立 的 几何 模型 。 

为 了 描述 每 个 连 杆 与 相 邻 连 杆 之 间 的 相对 位 置 关系 ， 需 要 在 每 个 连 杆 上 定义 一 个 固 连坐 
标 系 。 根 据 固 连 坐标 系 所 在 连 杆 的 编号 对 固 连 坐标 系 命名 ， 因 此 固 连 在 连 杆 i 上 的 固 连 坐标 
系 称 为 坐标 系 lilo 

通常 按照 下 面 的 方法 确定 连 杆 上 的 固 连 坐标 系 : 坐标 系 li) 的 和 轴 称 为 2， 并 与 关节 
轴 重合 ， 坐 标 系 | 计 的 原点 位 于 公 重 线 a 与 关节 轴 站 的 交点 处 。X, 沿 a 方向 由 关节 i 指 
[A i-l, 

当 a, =0 时 , X, EHS Z, M Z, MERE. AFEA X, 轴 的 转角 定义 为 a;， 由 于 
X, 轴 的 方向 可 以 有 两 种 选择 ， 因 此 a 的 符号 也 有 两 种 选择 。Y, 轴 由 右手 定 则 确定 ， 从 而 完成 
了 对 坐标 系 | 计 的 定义 。 图 7-109 所 示 为 一 般 连 杆 坐标 系 1i-1|} 和 oj 的 位 置 。 

在 研究 机 器 人 运动 学 问题 时 ， 我 们 都 会 选取 一 个 参考 坐标 系 ， 并 在 找 个 参考 坐标 系 中 描 
述 所 有 其 他 连 杆 坐标 系 的 位 置 。 

参考 坐标 系 10] 可 以 任意 设 定 ， 但 是 为 了 使 问题 简化 ， 通 常设 定 Zu au li 
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方向 ， 并 且 当 关节 变量 1 为 0 时 ， 设 定 参 考 坐 标 系 10] 与 坐标 系 11} 重合 。 


Fd 7-109 


空间 相 邻 的 两 相 邻 杆 件 


如 果 按 照 上 述 规定 ， 则 连 杆 参数 规定 如 下 : 

o; , 1B x, VH, Moz, | 旋转 到 z, 的 角度 ， 记 作 Rot (xii, 0o; 4); 

Q = x, HH, 从 z ,移动 到 z, 的 距离 ，Trans (xii 85:4); 

d;= 沿 z,_ 轴 ， 从 xx,_ | 移动 到 x, 的 距离 ，Trans (z, dj); 

0, 2 156 z, HH, A x EE x; 的 角度 ，Rot (z, 0). 

旋转 (ai) 一 全 平移 (a) 一 一 平移 (di) 一 一 旋转 (0,) ， 变 换 和 矩阵 是 : 
T^'-Rot (x,1, Qi1) Trans (z, ,, a; ,) Trans (z,, d;) Rot (z,, 0,) Hil. 


i 


i-1 
T, 


i 


[1 0 


[e] 
[e] 
R 
1 


© m oO CO 


cot; 50; 
sat; s; 


0 


确定 位 姿 矩 阵 参数 的 步 又 如 下 : 
1) 找 出 各 关节 轴 ， 并 标 出 〈 或 画 出 ) 这 些 轴线 的 延长 线 。 在 下 面 的 步 又 2 到 5 中 ， 仅 


考虑 两 个 相 邻 的 轴线 (关节 轴 i 和 ii+1)。 


0 0175100 œ, 
-sx 0| fo 10 0 
e, 0| 001 0 
0 1 0 0 0 1 
01 Fco, -s0, 0 0 
0| |s cg 0 0 
alo o 10 
1 0 0 0 1 
-s0 0 d; | 
ca; ,C0,  —so; ,  —diso, , 
(7-7) 
sa; c0; cca, d;co; , 
0 0 1 


2) RKR TA i Mil 之 间 的 公 重 线 或 关节 轴 守 和 1i+l 的 交点 ， 以 i+1 之 间 的 交点 或 


M 
D> 


垂 线 与 关节 轴 的 交点 作为 连 杆 坐标 系 1 的 原点 。 


171 


3) 规定 Z, TH OR 5 A 的 指向 。 

4) HUE x, 轴 沿 公 垂 线 的 指向 ， 如 果 关 节 轴 i 和 i+1 相交 ， 则 规定 X, 轴 垂 直 于 关节 轴 
和 i+1 所 在 的 平面 。 

5) 按照 右手 定 则 确定 Y, 轴 。 

6) 当 第 一 个 关节 变量 为 0 时 ， 规 定 坐标 系 10| 和 11} 重合 。 对 于 坐标 系 INI, K 
原点 的 方向 可 以 任意 选取 。 但 是 在 选取 时 ， 通常 尽 量 使 连 杆 参数 为 0。 

注意 : 按照 上 述 方法 建立 的 连 杆 固 连 坐标 系 并 不 是 唯一 的 。 首 先 ， 当 选取 2Z, 轴 与 关节 1 
重合 时 ，2; 轴 的 指 问 有 两 种 选择 。 此 外 ， 在 关节 轴 相 交 的 情况 下 (这 时 a, 20), HT X; 轴 
垂直 与 Z 轴 与 Z,,, 轴 所 在 的 平面 ， 因 此 X, 轴 的 指向 也 有 两 种 选择 。 当 关节 轴 与 +1 平行 
时 ， 坐 标 系 [i] 的 原点 位 置 可 以 任意 选择 (通常 选取 该 原点 使 之 满足 d; =0)。 

3. 重心 坐标 的 确定 

根据 机 器 人 各 个 关节 的 质量 和 它 的 位 姿 矩 阵 〈 在 此 不 做 推导 ) ， 我 们 可 以 求 出 机 器 人 各 
个 关节 质点 相对 于 坐标 原点 〈 头 部 ) 的 坐标 ， 并 且 可 进一步 求 出 机 器 人 的 重心 坐标 。 重 心 
坐标 的 求解 公式 如 下 : 


0.= (X0, xm, )/ Xv. (7-8) 
式 中 0. 一 一 重心 的 位 置 ，; 
0 一 第 i 个 舵 机 质点 的 位 置 ; 
m, 一 第 ;个 能 机 质点 的 质量 。 


R^ IP 
T? = Er NE (7-9) 
0 : 1 
Xo oa P. 
P, = 400) ?oo | 一 P, (7-10) 
70 04 Pa 


式 中 P? ——0, 点 的 径 向 Pj 在 坐标 系 So 中 的 表示 ， 是 一 个 3 x1 列 阵 (MEERE) ; 


0A 


R? 一 一 坐 标 系 S, 在 坐标 系 So 中 的 表示 ， 是 一 个 3 x3 的 方 阵 (姿势 矩阵 ) ; 
T? 一 一 称 为 位 姿 矩 阵 ， 用 4 x4 的 方 阵 同 时 把 位 置 和 姿态 表示 出 来 。 


四 、 实 验 步 又 


1. 简化 连 杆 模型 的 坐标 系 建立 
1) 根据 连 杆 模型 工 ( 见 图 7-110) ， 将 参数 值 填 人 表 7-9 中 ， 并 写 出 其 对 应 的 位 姿 矩 


表 7-9 EIRE I 参数 值 表 


将 其 参数 值 带 入 式 (7-7) 中 : 
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c0, —- s6, 0 d; | 
pi ca; ,s0;, co; c0; -Sa 一 disai 
i sa; ,sÜ; so; ,c0; co, d;co; , 
| 0 0 0 1 
带 和 结果 为 
DEL XL GO 3) 
ges () () () 0 
' 0 () C OO 
0 0 0 1 


2) 连 杆 模型 卫 ( 见 图 7-111) 将 参数 值 填 人 表 7-10 中 ， 并 写 出 其 对 应 的 位 姿 矩 阵 。 


图 7-110 连 杆 模型 [ 图 7-111 连 杆 模型 开 


注 : 图 7-111 中 2,_, 轴 与 Z; 轴 是 垂直 的 。 
X70 ERE I SRE 


将 其 参数 值 带 入 公式 (7-7) F: 


c0; - s0; 0 aii 
za 1600.50; ca; cð; -sa  -dsaj, 
dia sQ; ,sÜ; so; 1c0 co, d;co; , 

0 0 0 1 
带 入 结果 为 

() () () € 
ME E E 

() () () 0 

0 0 0 | 
2. 机 器 人 连 杆 坐 标 系 的 建立 z 12 
我 们 的 实验 用 双 足 机 器 人 有 着 17 FEBR, Re 


体 自由 度 配 置 〔 对 每 一 个 能 机 进行 了 编号 ,以便 uo) sumi nmm 
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操作 和 控制 。 头 部 舵 机 本 为 4 号 ， 但 在 连 杆 坐标 系 的 建立 过 程 中 ， 我 们 将 头 部 作为 了 参考 坐 
标 系 ， 为 便于 理解 ， 因 此 将 序号 设 为 0。 如 图 7-112 所 示 。 
图 中 ，@ 表 示 舵 机 在 水 平面 转动 ; 
ERRELE H FE 
下 面 ， 我 们 以 右 臂 为 例 ， 建 立 其 坐标 系 ， 并 列 出 对 应 的 位 姿 矩 阵 。 
根据 图 7-113 ， 将 参数 填 人 表 7-11 中 。 


图 7-113 “ 右 臂 部 分 坐标 系 


表 7-11 右 辟 参数 值 


| Qi-1 d; 6; 


将 表 7-11 中 的 参数 带 入 式 (7-7), W 


[O 


-— 
T 


ps 


LO 


O0 


O0 


O O 000 
Ol 4.[O O O O 

QI 9710. O 4 10 

O O O00 

0 

MELLON EL 10| WERE, 
0 


T2TTT -TT..d4:3 号 质点 相对 于 10| 的 位 姿 矩 阵 。 

3. 使 用 MATLAB 编写 机 器 人 模型 程序 

1) 如 图 7-114 所 示 ， 启 动 MATLAB 应 用 程序 ， 在 Current Directory 窗口 中 列 出 了 MAT- 
LAB 默认 路 径 中 包含 的 所 有 文件 ， 其 中 有 一 个 robotl. m 文件 。 选 择 此 文件 双击 ,或 者 在 
MATLAB 主 窗 口中 选择 打开 ， 然 后 选择 robotl. m 文件 打开 。 

2) 如 图 7-115 所 示 ， 在 robotl. m 文件 中 ， 编 写 右 臂 的 位 姿 矩 阵 部 分 代码 。 

3) 打开 上 位 机 控制 软件 ， 在 界面 中 单 击 “ 浏 览 ” 按 钮 ， 选 择 一 个 机 器 人 行为 数据 ， 例 
如 ， 走 . dat 文件。 选择 文件 后 的 界面 如 图 7-116 所 示 。 


Dc [lr Tp ^ Current Directory: | CATLAB6p5wwork iyi 则 

LIES x 
| D: MMTTABGpS work - El [£] P dà Using Toolbox Path Cache. Type "help toolbox path cache" for more inf | 
All Files File Ty To get started, select "MATLAB Help" from the Help menu. 


[]MetienCtri grt i 


]MotionCtr?, sfcn Be & arn AA Jg Stade xj 


[L]MetionCtr3 sfcn 


Notionmtr2 rsim View Text Debug Breakpoints Web Window Help 


function robot! (ql, g2, q3, alc, qe, q3c, qlrl, q?v1, girl, atrl, qBr1, q111, a711, q311, q411, q511) 


[robot 11-99. 94; 
sfprj 12=29. 42; 


EELE 13-53. 92; 


1111-44. 82/2;11rl-41. 82/2; 


国 m， 1211-83.14 ;12rl-83.14; 
AME 1811-41. 44; 13r1=41. 44; 


Ep 


*X-- 12/18/06 


1411-47. 40 ;l4rl-4T. 40; 
Dire 1511-53. 92;15r1-53. 92; 
1611-41. 44;16rl-41. 44; 
17=16. 56;% 臂 间 长 度 
m0=45. 406; 

m1-84. 048; 

m2-52. 0975; 

m3=69. 853; 


Current 


1:55 


mli-BB.53l: 


4| 


LE 


图 7-114 启动 并 打开 MATLAB 模型 文人 


B D:WIATLAB6p5workiroboti.m 


File 


Edit "View Text Debug Breakpoints Web Window Help 


= 2E &  dÀ f, €x IB sik Hh 
z qgörl=q3r1,/180*pi ; 
Em girl-gdárl/180x*pi; 


q5rl-q5rl/180*pi ;% 对 能 机 的 天 个 角度 : 
zy=46. 25; 
zxl-12.80; 


rx2=32. 46:% 脚 学 的 一 些 参 数 


知青 在 下 面 境 写 右 党 的 位 子 算 阵 


m TOlc=[0 0 -1 -11;-sin(glc] -cos gle) 0 D:-cosíglc) siníglc) O 0:0 001]; 


4| | 


roboti L 


图 7-115 5 t DLEA I ESRB ERA 
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“F ROBCON m 


EF BEMA 设置 大助 
速度 控制 同步 


gusee 2 s 9s 9. 


vcm fs «[ | »||mas hr «| | d» 

a m ja E Hg 

wom «| | H| wow | 1 | "| 

vc lo al >| 

moc Br al o| | dv crs [100 [| >] 
^| | [v CHl4 |99 | »| 


xl 
8 


x 
ge 
ed 
m 
a 


«l| «I 
a 

E 

m 
E 

in 

P 


ttiig EE. dat Üli 添加 插入 发 送 


序号 | DATA | SPEED | cut. | cue | cua | cua | cus | cuo | cwr | cuo | ca | eut 
DATA 12 102 8T 179 179 100 97 117 120 


DATA 5 
DATA 4 
DATA 1 
DATA 4 
MATA 4 


i 


当前 状态 | 数据 读 职 完成 ”传送 进度 


Bu | me | 清空 | 运行 | s | | ww] 退出 


72416 ”上 位 机 控制 软件 界面 


这 些 数 据 是 已 有 的 机 器 人 行为 数据 ， 因 此 每 一 组 数据 都 应 满足 稳定 性 条 件 ， 用 MATLAB 
仿真 ， 则 ZMP 点 都 应 落 在 稳定 裕 内 。 我 们 随意 选择 其 中 的 一 组 数据 ， 例 如 第 2 组 ， 则 舵 机 

[13, 19, 97, 179, 168, 98, 97, 85, 72, 115, 95, 100, 99, 116, 74, 92] 

从 上 面 的 数据 可 以 看 到 ， 我 们 在 选择 舵 机 数据 时 没有 包括 CHA 的 数据 ， 这 是 因为 CH4 
是 头 部 的 艇 机 ， 而 我 们 将 头 部 作为 了 重心 模型 的 坐标 原点 。 

4) 如 图 7-117 Brzs, YE MATLAB 的 命令 窗口 中 输入 

robotl (13, 19, 97, 179, 168, 98, 97, 85, 72, 115, 95, 100, 99, 116, 74, 92) 

回 车 后 ， 观 察 其 仿真 结 

5) 输入 命令 后 回 车 ， 将 会 出 现 MATLAB 仿真 图 形 ， 并 根据 仿真 图 形 完成 以 下 结论 。 

结论 : 输入 的 角度 数据 在 下 载 到 机 器 人 中 时 ， 机 器 人 是 否 处 于 稳定 状态 。 即 ， 数 据 本 
身 是 否 是 可 以 让 机 器 人 稳定 的 数据 。( 是 或 否 ) 
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File Edit view web window Help 
B Èp 9 Current Directory: | p:MATLABSpStwork bd 区 


six 


| D: MATLAS p5 work Y lE ck ġà Using Toolbox Fath Cache. Type "help toolbox path cache" for more inf 一 


All Files | File Ty To get started, select “MATLAB Help” from the Help menu. 


(JMotionCtri_grt_rtw Folder ^. 
>> robotl (13, 19, 97, 179, 168, 98, 97, 85, 72, 115, 95, 100, 99, 116, T4, 92) 


LL]MetionCtrZ rsim rtw Folder » 


LL]MetienCtr2 sfen rtw Folder 
LL]MetienCtr3 sfen rtw Folder 
[L Jrobot Folder 
Lj sfrri Folder 
Lc 新 建立 件 来 Folder 
00. m I-£ile 
[A a sew asv a a 


3 


— L| Current Directory | Workspace | 


ax 


X-- 12/18/08 1:55 TM 一- 名 


roboti (13, 19, 97, 173, 168, 95, 97, 85, T2, 115, 95, 100, £ 


7-117 YE MATLAB 主 界面 输入 命令 


凶 仿 真 图 形 中 ， 重 心 在 稳定 域 中 的 投影 是 否 在 稳定 域 之 内 。( 是 或 否 ) 

6) 当 我 们 改变 行为 数据 中 的 一 个 或 多 个 数据 后 再 输入 到 MATLAB 中 进行 验证 ， 看 看 改 
变 后 的 行为 数据 是 否 还 能 满足 稳定 性 条 件 。 例 如 ， 我 们 将 上 面 的 数据 改 为 : robotl (13, 19, 
97, 179, 168, 98, 97, 10, 30, 115, 95, 100, 99, 116, 74, 92) ， 改 变 了 两 个 数据 后 再 
次 进行 仿真 。 

结论 : 中 输入 的 角度 数据 在 下 载 到 机 器 人 中 时 ， 机 器 人 是 否 处 于 稳定 状态 。 即 数据 本 身 
是 否 是 可 以 让 机 带 人 稳定 的 数据 。( 是 或 否 ) 

凶 仿 真 图 形 中 ， 重 心 在 稳定 域 中 的 投影 是 否 在 稳定 域 之 内 。( 是 或 否 ) 


五 、 思 考题 


1. 选择 头 部 作为 坐标 原点 有 什么 好 处 ? 

答 : 对 于 本 文中 研究 的 每 一 个 模型 ， 坐 标 系 建立 是 非常 重要 的 ， 它 的 选取 直接 影响 到 整 
个 模型 的 计算 量 大 小 、 模 型 的 实现 、 模 型 的 稳定 性 ， 所 以 坐标 系 的 建立 在 整个 模型 中 是 非常 
基础 的 ， 在 重心 模型 中 之 所 以 选取 头 部 为 坐标 系 的 原点 ， 是 基于 以 下 两 点 原则 选取 的 。 

1) 由 于 重心 模型 的 建立 是 为 了 以 后 更 好 地 实现 步行 控制 ， 那 么 在 步行 控制 中 ， 坐 标 原 
点 应 选取 在 机 器 人 的 某 个 位 置 ， 这 样 可 以 使 计算 量 尽 可 能 小 ， 和 否则 ， 如 果 选 取 地 面 上 的 某 
个 位 置 作为 坐标 原点 ， 随 着 机 需 人 的 运动 ， 机 器 人 的 每 一 点 的 坐标 的 绝对 值 将 增 大 ， 这 样 模 
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型 的 计算 量 就 会 大 大 增加 。 

2) 在 机 器 人 的 步行 运动 过 程 中 ， 头 部 一 般 只 是 较 之 前 一 状态 发 生平 移 ， 不 发 生 旋转 ， 
所 以 选择 头 部 为 坐标 系 原点 ， 计 算 量 就 会 尽 可 能 减 小 。 

2. 机 器 人 有 17 台 舵 机 ， 在 用 MATLAB 仿真 行为 数据 的 稳定 性 时 ， 为 什么 输入 的 舵 机 角 
度 参数 只 有 16 个 呢 ? 

A&. 我 们 在 选择 能 机 数据 时 没有 包括 CHA 的 数据 ， 这 是 因为 CHA 是 头 部 的 舵 机 ， 而 我 
们 将 头 部 作为 了 重心 模型 的 坐标 原点 。 

3. 建立 基础 坐标 系 时 , X、Y、Z 轴 的 方向 选取 是 唯一 的 吗 ? 选择 的 不 同 会 有 什么 影响 ? 

答 : 建立 的 坐标 系 中 轴 方 向 的 选取 并 不 是 唯一 的 ， 不 过 根据 基本 的 规则 去 选择 轴 的 方向 
会 减少 很 多 不 必要 的 计算 量 ， 简 化 模型 。 并 且 结 果 不 会 受到 影响 。 


实验 十 ”多 智能 体 协 调控 制 


一 、 实 验 目的 


1) 进一步 见 悉 上 位 机 软件 对 类 人 双 足 步行 机 器 人 的 控制 。 
2) 掌握 多 智能 体 控制 的 思想 。 
3) 发 挥 同学 们 的 创作 能 力 ， 编 排 经 典 的 “ 千 手 观音 ”部 分 动作 。 


二 、 实 验 设 备 


PC 一 台 CRE VC 程序 ， 双 足 步行 机 器 人 上 位 机 控制 软件 ) 、 无 线 通信 模块 /串口 通信 
线 、 双 足 步 行 机 器 人 一 组 五 台 、 充 电 电池 五 套 。 


三 、 实 验 原理 与 说 明 


智能 体 Agent 是 指 那些 宿主 于 复杂 的 动态 环境 ， 自 主 感知 环境 中 信息 ， 自 主 采 取 行 动 ， 
并 实现 一 系列 预先 设 定 的 目标 或 任务 的 计算 机 系统 。 它 具有 推理 和 学 习 能 力 、 自 主 与 协同 工 
作 能 力 以 及 在 所 处 环境 中 的 灵活 访问 和 迁移 机 制 以 及 同 其 他 智能 Agent 的 通信 和 协调 机 制 ， 
概括 起 来 就 是 智能 性 、 代 理性 和 机 动 协调 性 。 该 技术 最 早出 现在 人 工 智 能 领域 ， 其 最 大 特点 
是 具有 一 定 的 智能 及 良好 的 灵活 性 和 坚定 性 ， 特 别 适 合 处 理 复杂 、 难 以 预测 的 问题 。 基 于 智 
能 体 的 控制 模型 是 一 种 拟人 化 的 模型 ， 可 将 控制 系统 的 行为 和 其 他 扩展 单元 的 行为 统一 起 来 
构成 分 布 式 多 智能 体系 统 。 

多 智能 体系 统 (Multi - Agent System) 是 由 多 个 可 计算 的 智能 体 组 成 的 集合 ， 它 能 协调 
一 组 自主 体 的 行为 (知识 、 目 标 、 方 法 和 规划 等 )， 以 协同 地 动作 和 求解 问题 学习 是 多 知 
能 体系 统 的 重要 特征 之 一 ， 多 智能 体 学 习 可 以 看 做 是 多 智能 体系 统 和 机 器 学 习 等 研究 领域 的 
交叉 。 强 化 学 习 是 一 种 以 环境 反馈 作为 输入 的 适应 环境 的 机 器 学 习 方 法 。 它 不 需要 对 环境 的 
先 验 知 识 具 有 无 监督 的 自 适应 能 力 ， 因 而 被 认为 是 设计 智能 Agent 的 核心 技术 之 一 。 

多 智能 体系 统 是 针对 一 群 不 同 种 类 的 、 自 治 的 智能 体 的 群体 行为 所 进行 的 研究 ， 这 些 智 
能 体 可 能 为 同一 目标 共同 工作 ， 也 可 能 为 存在 潜在 冲突 的 各 自 不 同 的 目标 工作 。 在 具体 的 研 
究 工 作 中 ， 多 个 智能 体 之 间 如 何 协调 运用 各 自 的 知识 、 目 标 、 技 能 和 计划 共同 采取 行动 、 解 
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决 问题 是 一 个 重要 的 研究 内 容 。 多 机 器 人 系统 为 多 智能 体系 统 理论 应 用 于 实际 环境 中 提供 了 
实验 平台 ， 同 时 多 智能 体系 统 理论 的 研究 为 多 机 器 人 系统 和 多 机 器 人 协调 协作 提供 了 理论 基 
础 。 

对 于 多 个 机 器 人 的 控制 ， 就 涉及 多 智能 体 (Multi — Agent). 控制 的 思想 。 每 个 机 器 人 其 
实 对 应 的 就 是 其 中 的 单个 智能 体 ， 我 们 通过 上 位 机 程序 和 无 线 通 信 模 块 来 对 多 个 机 器 人 进行 
控制 ， 实 现 了 一 对 多 的 多 智能 体 控 制 。 

机 器 人 都 有 自己 的 ID 号 ， 每 个 ID 号 就 如 同 它 们 自己 的 名 字 。 在 上 位 机 界面 中 ， 当 我 们 
输入 ID 号 时 ， 相 应 的 机 器 人 就 会 按照 所 设 定 的 动作 组 号 做 出 相应 动作 ， 这 就 实现 了 “一 对 
一 ”的 控制 。 那 对 于 一 对 多 的 控制 ， 我 们 规定 了 机 器 人 公用 的 ID 号 ， 当 我 们 输入 公用 ID 号 
时 ， 所 有 开启 电源 的 机 器 人 都 会 受到 控制 ， 这 就 是 所 谓 “ 一 对 多 ”的 控制 。 本 实验 分 为 实 
验 (一 ) 和 实验 (二)， 实验 (一 ) 体现 了 一 对 多 智能 控制 的 延 时 协同 控制 ; 实验 二 体现 
了 一 对 多 智能 控制 的 实时 协同 控制 。 

在 做 这 个 实验 的 时 候 ， 我 们 要 求 同 学 分 组 ， 每 组 六 名 ， 并 且 配 备 五 台 双 足 类 人 机 器 人 。 
动作 数据 调试 完毕 之 后 ， 将 五 台 双 足 类 人 机 器 人 按 一 列 站 位 ， 这 也 就 是 表演 “ 千 手 观音 ” 
的 站 位 ， 如 图 7-118 所 示 。 


图 7-118 ” 双 足 机 器 人 表演 “ 千 手 观音 ”的 站 位 示意 图 


四 、 实 验 步 又 


实验 (一 ) ”编排 干 手 观 音 动作 之 一 一 一 “ 开 佛手 ” 

1) 对 于 千 手 观音 的 表演 来 说 ， 最 吸引 人 的 葛 过 于 “ 开 佛 手 ”， 如 图 7-119、 图 7-120 所 
示 的 是 千 手 观音 中 开 佛手 的 动作 ， 具 有 观赏 性 ， 有 比较 好 的 演示 效果 。 

2) 关于 “ 开 佛 手 ” 的 动作 ， 我 们 通过 看 图 片 ， 就 可 以 发 现 每 个 机 带 人 的 动作 其 实 是 一 
样 的 ， 都 是 将 双 臂 慢 慢 展开 到 头 上 方形 成 拱 形 ， 然 后 再 将 双 臂 放下 。 那 么 如 何 使 得 每 个 机 器 
人 的 动作 都 会 一 致 呢 ? 


am 
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3) 如 果 要 让 5 个 机 器 人 的 动作 能 一 致 ， 就 具有 临摹 法 〈 即 用 一 个 机 器 人 来 做 模板 ， 
他 机 器 人 照样 子 学 ， 机 器 人 站 立 顺 序 可 由 动作 编排 者 自行 排列 ) 。 先 将 第 一 个 机 器 人 设计 展 
开 佛手 的 动作 ， 这 个 时 候 只 考虑 这 个 机 器 人 ， 不 要 考虑 其 他 机 器 人 。 我 们 可 以 直接 将 机 器 人 


的 “ 开 佛手 ”动作 分 为 几 部 分 。 

动作 一 : 初始 位 置 (Homeposition ) , 
它 是 每 个 动作 最 开始 的 准备 部 分 。 具 体操 
作 步 又 : 单 击 “ 设 定 初始 位 置 一 读 取 初 始 
位 置 数据 ”， 打 开 初 始 位 置 为 名 的 文件 夹 ， 
读 取 第 一 个 机 器 人 的 初始 位 置 数据 (如 
1. hos) ， 注 意 在 上 位 机 程序 界面 中 速度 控 
制 设 为 4， 单 击 “ 添 加 ”按钮 ， 将 初始 位 
置 数据 放置 在 数据 显示 区 域 中 ， 作 为 将 要 
调试 的 开 佛手 动作 的 开始 。 


动作 二 : 拖 动 2、3、6、7 号 舵 机 对 | 


应 的 滑 块 将 机 器 人 双 臂 举 到 头顶 ， 形 成 如 
图 7-120 所 示 第 一 个 机 器 人 的 拱 形 动作 ， 
注意 在 上 位 机 程序 界面 中 速度 控制 设 为 
4， 单 击 “ 添 加 ”按钮 ， 将 动作 二 的 数据 
放置 在 数据 显示 区 域 中 。 

动作 三 : 初始 位 置 (Homeposition ) ， 
它 又 是 每 个 动作 的 最 末端 的 结束 部 分 ， 具 
体操 作 步 又 如 动作 一 。 


e: 
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我 们 先 把 第 一 个 机 器 人 的 这 三 个 动作 实现 了 。 然 后 单 击 “ 保 存 ” 按 钮 ， 将 此 数据 以 
“ 开 佛手 ”为 名 保存 在 以 机 器 人 ID 号 (如 1 号) 为 名 的 文件 夹 中 。 

4) 接 下 来 ,我 们 将 第 一 个 机 器 人 作为 模板 ， 让 其 他 4 个 机 器 人 所 编 的 动作 一 、 动 作 二 
都 和 第 一 个 机 器 人 的 动作 相同 ， 速 度 控制 也 设 为 4， 重复“ 步骤 3”。 在 这 个 环节 ， 要 求 5 个 
机 器 人 上 述 “ 步 又 3” 的 动作 二 相同 ， 基 本 没有 偏差 。 具 体 作 法 : 读 取 第 一 个 机 器 人 动作 二 
的 数据 ， 证 其 做 动作 二 ， 然 后 将 第 一 个 机 器 人 断 电 使 其 保持 动作 二 ， 然 后 以 第 一 个 机 器 人 作 
为 模板 来 调 其 他 4 个 机 器 人 的 动作 二 。 同 时 我 们 将 上 位 机 程序 里 的 也 号 设 为 公共 ID 号 127 ， 
使 得 5 个 机 器 人 一 起 做 动作 二 。 

5) 最 后 是 要 把 延 时 加 入 动作 中 ， 因 为 “ 开 佛 手 ” 需 要 每 个 机 器 人 的 动作 有 一 定 的 延 时 
性 ， 这 样 才 保 证 具有 图 7-120 的 效果 。 首 先 对 于 第 一 个 机 器 人 ， 要 将 动作 二 的 动作 数据 持续 
八 行 ， 使 得 动作 二 能 持续 一 段 时 间 。 而 动作 一 、 动 作 三 都 为 初始 位 置 ， 不 需要 加 延 时 ， 只 要 
一 行 就 够 了 。 具 体操 作 步 又 : 单 击 “ 浏 览 ” 按 钮 ， 在 以 机 右 人 I 有 D 号 (如 1 号 ) 为 名 的 文件 
夹 中 读 取 第 一 个 机 器 人 “ 开 佛 手 ” 的 动作 数据 ， 双 击 动作 二 对 应 的 动作 数据 行 ， 然 后 再 单 
击 动作 二 对 应 的 动作 数据 行 ， 再 单 击 “ 插 入 ”按钮 ， 然 后 再 单 击 刚刚 插入 的 动作 数据 行 ， 
再 单 击 “ 插 入 ”按钮 ， 如 此 进行 下 去 插入 7 行 ， 将 动作 二 的 动作 数据 持续 8 行 。 延 时 加 完 
之 后 ， 将 数据 保存 后 ， 将 该 组 开 佛 手 的 动作 数据 通过 无 线 或 是 有 线 的 方式 发 送 给 第 一 个 机 器 
人 ， 单 击 上 位 机 控制 界面 下 端的 “发 送 ”按钮 [在 单 击发 送 之 前 要 对 控制 界面 中 的 “组 号 ” 
进行 配置 ， 组 号 可 以 自行 设 定 ， 如 “ 开 佛 手 ” 的 动作 组 号 设 为 6，ID 号 为 第 一 个 机 器 人 的 
ID ^ (如 1 号 )]， 将 已 调试 好 的 开 佛 手动 作 发 送 至 下 位 机 ， 出 现 对 话 框 后 单 击 “确定 ”， 
之 后 单 击 “ 运 行 ”按钮 (同样 在 单 击 之 前 也 要 选择 相应 的 组 号 ) ， 第 一 个 机 器 人 将 完成 开 佛 
手动 作 。 

6) 对 于 第 二 个 机 器 人 ， 它 是 紧 跟 第 一 个 机 器 人 做 动作 的 ， 这 时 需要 在 动作 一 中 有 持 
续 ， 来 实现 机 器 人 动作 的 延 时 。 于 是 ， 将 第 二 个 机 器 人 的 动作 一 的 动作 数据 持续 15 行 ， 达 
到 延 时 效果 ， 具 体操 作 步 又 : 单 击 “ 浏 览 ” 按 钮 ， 在 以 机 器 人 I 有 ID 号 (如 2 号 ) 为 名 的 文件 
夹 中 读 取 第 2 个 机 器 人 “ 开 佛 手 ” 的 动作 数据 ， 双 击 动 作 一 对 应 的 动作 数据 行 ， 然 后 单 击 
第 一 行 数据 ， 再 单 击 “ 插 入 ”按钮 ， 然 后 再 单 击 刚刚 插入 的 动作 数据 行 ， 再 单 击 “ 插 入 ” 
按钮 ， 如 此 进行 下 去 插入 14 行 ， 将 动作 一 的 动作 数据 持续 15 行 。 然 后 将 动作 二 还 是 持续 8 
行 ， 即 双击 动作 二 对 应 的 动作 数据 ,然后 再 单 击 动作 二 对 应 的 动作 数据 行 ， 再 单 击 “ 插 入 ” 
按钮 ， 然 后 再 单 击 刚刚 插入 的 动作 数据 行 ， 再 单 击 “ 插 入 ”按钮 ， 如 此 进行 下 去 插入 7 行 ， 
将 动作 二 的 动作 数据 持续 8 行 。 动 作 三 还 是 保持 一 行 不 变 。 延 时 加 完 之 后 ， 将 数据 保存 后 ， 
将 该 组 开 佛手 的 动作 数据 通过 无 线 或 是 有 线 的 方式 发 送 给 第 2 个 机 器 人 ， 发 送 时 组 号 可 以 自 
行 设 定 ， 但 必须 为 0 ~20 之 间 未 用 过 的 数字 〈 如 “ 开 佛手 ”的 动作 组 号 设 为 6) ，ID 号 为 第 
2 个 机 器 人 的 用 号 (如 2 号 )。 

7) 对 于 后 面 的 第 3 个 、 第 4 个 、 第 5 个 机 器 人 ， 同 样 的 需要 将 动作 一 分 别 持续 25 行 、 
35 行 、45 行 ， 分 别 实 现 延 时 的 效果 。 而 对 于 这 后 面 的 3 个 机 器 人 ， 动 作 二 都 需要 持续 8 行 ， 
动作 三 都 还 保持 一 行 不 变 ， 具 体操 作 步 又 如 步骤 6) 。 

8) 最 后 将 5 个 机 器 人 摆 放 成 前 面 所 调 的 机 器 人 的 顺序 站 成 一 行 ， 并 且 打 开 电 源 ， 即 如 
图 7-118 所 示 的 “ 千 手 观音 ”的 站 位 队列 ， 程 序 界面 的 ID 号 设置 成 公共 ID 号 127， 然 后 运 
行 ， 我 们 可 以 看 到 “ 千 手 观 音 ” 之 “ 开 佛 手 ”动作 就 会 表演 出 来 。 
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9) 当然 如 果 效 果 不 是 最 佳 ， 可 以 考虑 在 某 个 机 器 人 要 持续 的 动作 的 行 数 上 改动 几 行 
(增加 或 减少 几 行 ) ， 因 为 每 个 机 器 人 都 会 存在 差异 ， 效 果 如 图 7-120 所 示 为 最 佳 。 

实验 (二 ) ”编排 千 手 观音 动作 之 二 一 一 “ 展 辟 ” 

1) 对 于 千 手 观 音 的 表演 来 说 , “ 展 辟 ”也 是 很 重要 的 一 环 ， 要求 所 有 机 器 人 同时 做 动 
作 ， 而 且 每 个 机 器 人 癌 不 同方 向 展 辟 ， 如 图 7-121、 图 7-122 所 示 。 


图 7-121 双 足 机 器 人 表演 “ 千 手 观音 ”之 “ 展 臂 ”示意 图 一 


K 7-122 ” 双 足 机 器 人 表演 “ 千 手 观音 ”之 “ 展 臂 ”示意 图 二 
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2) 关于 “ 展 辟 ”的 动作 ， 我们 通过 看 图 片 ， 就 可 以 发 现 每 个 机 器 人 的 动作 是 不 一 样 
的 ， 都 是 瞬间 从 初始 位 置 转 到 一 定 方向 ， 让 手臂 保持 某 个 特定 动作 一 段 时 间 ， 然 后 再 将 双 臂 
转 回 初始 位 置 。 

3) 我 们 可 以 直接 将 机 器 人 的 “ 展 臂 ”动作 分 为 4 部 分 。 

动作 一 : 初始 位 置 ， 它 是 每 个 动作 的 最 开始 的 准备 部 分 ， 如 对 第 一 个 机 器 人 具体 操作 步 
又 如 “实验 (一 )” 中 步骤 3) 的 动作 一 。 

动作 二 : 如 图 7-123 所 示 每 个 机 器 人 对 应 的 动作 。 如 对 于 第 一 个 机 器 人 ， 拖 动 2、3、6、 
7 号 舵 机 对 应 的 滑 块 将 机 器 人 双 臂 竖 直 举 过 头顶 ， 形 成 如 图 7-123 所 示 第 一 行 机 器 人 的 动作 ， 
单 击 “ 添 加 ”按钮 ， 将 动作 二 数据 放置 在 数据 显示 区 域 中 。 

动作 三 : 如 图 7-124 所 示 每 个 机 器 人 对 应 的 动作 。 如 对 于 第 一 个 机 器 人 ， 拖 动 2、3、6、 
7 号 能 机 对 应 的 请 块 将 机 器 人 双 臂 举 平 ， 形 成 如 图 7-124 所 示 第 一 行 机 器 人 的 动作 ， 单 击 
“添加 ”按钮 ， 将 动作 三 的 数据 放置 在 数据 显示 区 域 中 。 


第 5 行 第 51 

机 器 人 机 器 人 
第 4 行 第 4 行 
机 器 人 机 器 人 
第 3 行 第 3 行 
机 器 人 机 器 人 
第 2 行 第 2 行 
机 器 人 机 器 人 
第 1 行 第 1 行 
机 器 人 机 器 人 

图 7-123 5 个 机 器 人 动作 二 的 正面 示意 图 图 7-124 5 个 机 器 人 动作 三 的 正面 示意 图 


动作 四 : 初始 位 置 ， 它 又 是 每 个 动作 的 最 末端 的 结束 部 分 ， 如 对 于 第 一 个 机 器 人 具体 操 
作 步 又 如 “实验 (一 )” 中 步骤 3) 的 动作 三 。 

然后 单 击 “ 保 存 ” 按 钮 ， 将 此 数据 以 展 辟 为 名 保存 在 以 机 器 人 了 D 号 (如 1 号 ) 为 名 的 
文件 夹 中 。 同 理 ， 其 他 四 个 机 器 人 也 如 上 述 4 个 部 分 来 编排 展 臂 动作， 不 同 的 是 他 们 的 动作 
二 、 动 作 三 应 分 别 对 应 图 7-123 和 图 7-124 所 示 的 每 个 机 器 人 的 动作 来 调 。 

4) 由 于 “ 展 辟 ”需要 5 个 机 器 人 同时 做 动作 ， 所 以 这 里 规定 每 个 机 器 人 都 要 遵守 下 列 
规定 : 动作 一 要 保持 的 行 数 为 4 行 (速度 控制 设 为 4) ， 动 作 二 要 保持 的 行 数 为 40 行 (第 一 
行 速 度 控制 设 为 7， 其 余 都 设 为 1) ， 动 作 三 要 保持 的 行 数 为 40 行 〈 第 一 行 速度 控制 设 为 7， 

其 余 都 设 为 1)、 动作 四 要 保持 的 行 数 为 工行 〈 速 度 控制 设 为 7) ， 按 照 上 述 规 编 定 写 动作 
将 体现 一 对 多 智能 控制 的 实时 控制 。 
例如 对 于 第 一 个 机 器 人 ， 要 将 动作 一 的 动作 数据 持续 4 行 ， 具 体操 作 步 又 : 单 击 “ 浏 
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W” TREE, EDLA ID 7. (A1 7). 为 名 的 文件 夹 中 读 取 第 一 个 机 器 人 “ 展 辟 ”的 动作 
数据 ， 双 击 动作 一 对 应 的 动作 数据 行 ， 速 度 控 制 设 为 4， 然 后 再 单 击 动作 一 对 应 的 动作 数据 
行 ， 再 单 击 “搬入 ”按钮 ， 然 后 再 单 击 刚刚 插入 的 动作 数据 行 ， 再 单 击 “插入 ”按钮 ， 如 
此 进行 下 去 插入 3 行 ， 将 动作 一 的 动作 数据 持续 4 行 。 要 将 动作 二 的 动作 数据 持续 40 行 ， 
双击 动作 二 对 应 的 动作 数据 ， 速 度 控制 设 为 7， 然 后 再 单 击 动 作 二 对 应 的 动作 数据 行 ， 单 击 
“修改 ”"， 然 后 再 速度 控制 设 为 1， 单 击 动作 二 对 应 的 动作 数据 行 ( 速度 控制 已 设 为 7) 的 下 
一 行 ， 再 单 击 “ 插 人” 按钮， 然后 再 单 击 刚刚 插入 的 动作 数据 行 ， 再 单 击 “ 插 入 ”按钮 ， 
如 此 进行 下 去 插入 39 行 ， 将 动作 二 的 动作 数据 持续 40 行 ， 同 理 为 动作 三 按 上 述 规则 加 延 
时 。 最 后 将 动作 四 的 数据 速度 控制 修改 为 7。 延 时 加 完 之 后 ， 将 数据 保存 后 ,将 该 组 展 臂 的 动 
作 数 据 通 过 无 线 或 是 有 线 的 方式 发 送 给 第 一 个 机 器 人 ， 发 送 时 组 号 可 以 自行 设 定 , 但 必须 为 0 
-20 之 间 未 用 过 的 数字 (如 “ 展 臂 ”的 动作 组 号 设 为 7) ，ZD 号 为 第 一 个 机 带 人 的 了 D 号 
(如 1 号 )。 其 他 机 器 人 同 理 。 

5) 关键 部 分 在 于 每 个 机 絮 人 动作 二 、 动 作 三 的 编写 。 每 个 机 如 人 的 动作 二 、 动 作 三 都 
不 同 ， 且 要 求 在 编写 动作 二 时 ， 五 个 机 器 人 虽然 动作 不 相同 ， 但 总 体 上 看 ， 如 图 7-121 所 
示 ， 手 臂 的 空间 分 布 上 下 均匀 。 动 作 三 同 理 。 

6) 在 本 实验 中 ， 特 定 的 动作 二 、 动 作 三 不 拘泥 于 一 种 形式 ， 也 就 是 同学 们 编写 的 时 
候 ， 可 以 不 参照 图 7-121 与 图 7-122， 自 己 编写 ， 但 要 总 体 上 遵循 手臂 的 空间 分 布 上 下 均匀 ， 
具有 层次 感 ， 这 样 效 果 才 会 更 好 。 在 此 注意 一 点 ， 对 于 同一 个 机 器 人 ， 动 作 二 、 动 作 三 应 该 
Xp: 比如 动作 二 机 器 人 手臂 上 抬 ， 动 作 三 机 器 人 手臂 就 下 垂 。 

7) 当 每 个 机 器 人 都 编排 好 动作 后 ， 将 5 个 机 器 人 摆 放 成 前 面 所 调 的 机 器 人 的 顺序 站 成 
一 行 ， 并 且 打 开 电 源 ， 即 如 图 7-118 所 示 的 “ 千 手 观音 ”的 站 位 队列 ， 然 后 程序 界面 的 ID 
号 设置 成 公共 ID 号 127， 接 着 运行 ， 我们 可 以 看 到 “ 千 手 观音 ”之 “ 展 辟 ”动作 就 会 表演 
出 来 。 

8) 当然 如 果 效 果 不 是 最 佳 ， 可 以 考虑 在 某 个 机 器 人 要 持续 的 行 数 上 改动 几 行 〈 增 加 或 
减少 几 行 ) ， 因 为 每 个 机 器 人 都 会 存在 差异 。 


五 、 思 考题 


l. 机 融 人 的 “ 千 手 观音 ”动作 表演 中 的 延 时 是 怎样 实现 的 ? 

答 : 在 机 器 人 “ 千 手 观音 ”动作 表演 中 的 延 时 是 通过 对 上 位 机 界面 中 的 某 行 数据 进行 复 
制 ， 达 到 动作 持续 的 效果 。 在 这 里 ， 我 们 一 般 会 用 到 两 种 按钮 :“ 插 入 ”、“ 添 加 ”。 

其 中 “插入 ”按钮 用 得 最 普遍 ， 当 我 们 要 复制 某 行 数据 时 ， 首 先 先 双击 这 行 数据 ， 这 
时 发 现 滚动 条 也 随 之 显示 该 行 数据 ， 然 后 单 击 要 插入 的 位 置 的 下 一 行 ， 再 单 击 “插入 ” 按 
钮 ， 想 要 复制 的 行 就 复制 了 一 行 ， 由 此 想 要 复制 几 行 ， 就 单 击 “插入 ”按钮 几 下 。 实 现 动 
作 的 延 时 ， 当 然 复制 的 行 数 越 多 ， 延 时 越 长 。 

“添加 ”按钮 用 得 很 少 ,一 般 都 是 在 要 插入 的 位 置 后 面 已 经 没有 任何 数据 的 前 提 下 , 单 击 
“添加 ”按钮 , 想 要 复制 的 行 就 在 数据 的 最 后 一 行 复制 了 一 行 。 由 此 想 要 复制 几 行 ,就 单 击 “ 添 
加 ”按钮 几 下 ,注意 的 是 每 次 添加 的 行 都 是 在 最 后 一 行 ,以 前 复制 的 行 都 向 上 推进 。 

2. 我 们 是 如 何 用 一 个 上 位 机 程序 来 同时 控制 多 个 机 器 人 的 ? 

答 : 对 于 一 个 上 位 机 程序 对 多 个 机 器 人 的 控制 ， 我 们 规定 了 机 器 人 公用 的 ID 号 ， 当 我 
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们 输入 公用 ID 号 时 ， 所 有 开启 电源 的 机 器 人 都 会 受到 控制 ， 这 就 实现 了 一 个 上 位 机 程序 对 
多 个 机 顺 人 的 控制 。 

3. 我 们 从 机 老人 的 “ 千 手 观音 ”动作 中 的 “ 开 佛手 ”和 “ 展 臂 ” 可 以 得 出 什么 结 
利用 这 个 结果 ， 我 们 如 何 编排 新 动作 ? 

A: 对 于 机 器 人 的 “ 千 手 观音 ”动作 中 的 “ 开 佛 手 ”， 我 们 可 以 得 到 5 个 机 器 人 依次 延 
时 地 做 动作 时 ， 动 作 变 化 的 具体 行 数 ， 也 就 是 说 ， 当 我 们 设计 新 的 动作 ， 而 且 这 个 动作 要 求 
机 器 人 是 依次 延 时 地 去 做 ， 我 们 可 以 直接 利用 “ 开 佛手 ”得 到 的 结果 ， 知 道 每 个 机 器 人 在 
具体 哪 一 行 要 换 动 作 的 前 提 下 ， 将 动作 数据 编写 上 去 就 可 以 了 。 

同 理 ， 对 于 机 天 人 的 “ 千 手 观音 ”动作 中 的 “ 展 臂 ” ， 我 们 可 以 得 到 五 个 机 器 人 同时 做 
动作 时 ， 动 作 变化 的 具体 行 数 , 也 就 是 说 ， 当 我 们 设计 新 的 动作 ， 而 且 这 个 动作 要 求 机 器 人 
是 同时 地 去 做 ， 我 们 可 以 直接 利用 “ 展 臂 ”得 到 的 结果 ， 知 道 每 个 机 器 人 在 具体 哪 一 行 要 
换 动 作 的 前 提 下 ， 将 动作 数据 编写 上 去 就 可 以 了 。 

这 样 ， 我 们 可 以 利用 “ 开 佛 手 ” 和 “ 展 辟 ”的 结果 ， 编 排 任何 动作 ， 包 括 延 时 地 和 同 
时 地 做 动作 。 

4. 机 器 人 团队 除了 “后 手 观音 ”动作 之 外 ,还 适合 做 什么 样 的 团队 表演 ， 发 挥 想 象 列 
举 一 些 其 他 的 团队 表演 。 

A: 机 融 人 团队 除了 “ 千 手 观音 ”动作 之 外 ， 还 可 以 表演 一 些 团队 表演 ,例如 团队 街 
舞 表 演 、 团 队 体操 表演 、 团 队 扭 秧歌 表演 、 团 队 拾 花轿 表演 、 团 队 武 术 表演 、 团 队 打 太极 表 
演 、 团 队 踢 球 表 演 、 团 队 竞 赛 类 (跑步 、 翻 跟头 、 俯 甲 撑 ) 表演 、 团 队 拔 河 表演 等 。 


实验 十 一 ”复杂 动作 实验 


一 、 实 验 目的 


1) 进一步 熟悉 双 足 步行 机 器 人 上 位 机 控制 平台 的 操作 。 

2) 学 习 用 上 位 机 软件 ， 完 成 复杂 动作 一 一 疏 楼 梯 的 调试 ， 学 会 机 老人 复杂 动作 的 调试 
方法 。 

3) 掌握 发 送 多 组 数据 的 方法 。 

4) 擎 握 动作 编排 的 方法 。 


二 、 实 验 设备 


PC 一 台 (A VC 和 双 足 步行 机 器 人 上 位 机 控制 软件 ) 、 无 线 通信 模块 /串口 通信 线 、 
双 足 步行 机 器 人 一 台 ， 电 池 、 充 电 设备 各 一 套 。 

三 、 实 验 原理 与 说 明 

1. 复杂 动作 的 调试 方法 

在 简单 动作 实验 里 面 ， 我们 已 经 学 会 了 利用 上 位 机 来 完成 招手 动作 的 调试 ， 接 下 来 我 们 
来 介绍 一 组 复杂 动作 的 调试 过 程 。 

所 谓 复杂 动作 ， 就 是 指 整个 动作 全 部 完成 ， 需 要 很 多 帧 数据 ， 这 些 帧 顺序 执行 ， 可 以 形 
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成 一 组 比较 完整 并 稍微 复杂 些 的 动作 。 一 般 ， BRER RIEA EBGssllA7h, i86 7 
及 路 部 及 下 肢 各 舵 机 的 运动 ， 这 样 就 存在 机 器 人 重心 偏 移 后 各 舵 机 如 何 相互 配合 仍 使 机 器 人 
在 完成 每 一 帧 数据 后 保持 所 需 平 衔 的 问题 。 这 里 需要 注意 的 是 在 复杂 动作 中 ， 机 器 人 完成 每 
一 帧 动作 后 都 需 处 于 一 个 稳定 的 状态 〈 即 能 维持 平衡 ) ， 并 且 帧 与 帧 之 间 的 动作 差别 不 应 过 
大 ， 而 且 在 速度 位 的 设置 上 也 需 配合 动作 需要 ， 过 快 可 能 造成 机 器 人 由 于 惯性 失去 平衡 ， 过 
慢 则 导致 动作 的 可 观赏 性 下 降 。 

2. 让 机 器 人 执行 多 组 动作 的 方法 

多 动作 实际 上 是 由 多 组 简单 和 复杂 动作 按照 我 们 事先 设计 的 规则 顺序 执行 的 过 程 。 

首先 ， 我 们 需要 把 已 经 调试 好 的 各 个 动作 ， 顺 序 地 发 送 到 机 器 人 下 位 机 存储 器 的 不 同 
区 域 中 ， 然 后 通过 上 位 机 软件 自 带 的 动作 编排 窗口 进行 所 需 顺 序 的 动作 编排 ， 之 后 单 击 
“顺序 ”按钮 ， 就 可 以 执行 我 们 所 需要 的 动作 序列 了 。 有 具体 的 设置 方法 参见 下 面 的 实验 步 


WR. 
四 、 实 验 步骤 


1. 调试 一 组 复 林 动作 一 一 候 楼 梯 (这 里 我 们 只 以 上 一 级 台阶 为 例 进行 讲解 ， 上 多 级 台 
阶 方法 可 由 一 级 台阶 调试 方法 进行 推广 ) 

1) 打开 机 器 人 电源 开关 ， 上 电 后 机 器 人 处 在 初始 位 置 ( 双 脚 直立 状态 ) ， 先 将 机 器 人 
放 在 自制 的 楼 梯 前 ， 做 好 下 一 步调 试 准备 ， 并 单 击 上 位 机 界面 上 的 “ 设 定 初始 位 置 ” 一 
“ 读 取 初始 位 置 ” 调 出 已 调试 好 的 机 器 人 初始 位 置 数 据 ， 并 单 击 “ 添 加 ”按钮 ， 把 初始 位 置 
数据 作为 机 器 人 的 楼 梯 动 作 的 第 1 帧 ， 如 图 7-125 所 示 。 

2) 将 头脑 中 人 类 把 楼 梯 的 动作 分 解 成 一 个 个 更 细小 的 动作 ， 也 就 是 我 们 这 里 指 的 
“ 帧 " 。 首 先 假设 我 们 人 直立 站 在 楼 梯 台 阶 前 ， 下 一 步 动作 应 该 是 抬 脚 ， 即 一 只 脚 拾 起 来 ， 
男 一 只 脚 站 立 ， 且 要 保持 平衡 。 双 足 机 器 人 也 是 一 样 ， 下 一 帧 数据 就 是 要 让 机 器 人 一 脚 
站 立 ， 男 一 只 脚 离开 地 面 ， 这 中 间 不 可 能 只 有 离开 地 面 的 那个 舵 机 在 动 ， 因 为 要 平衡 ， 
另 一 只 脚 膀 部 舵 机 ， 脚 腕 部 舵 机 等 都 需要 调整 。 调 整 完 这 一 帧 数据 后 ， 机 器 人 仍 需 保持 
平衡 不 倒 。 

这 里 ， 我 们 首先 令 右 脚 作 为 机 器 人 支撑 脚 ， 左 脚 抬 起 ， 作 为 爬 楼 梯 动 作 第 2 Wi, 

要 完成 这 个 动作 ， 我 们 分 别 通 过 滑 块 修改 左 腿 跨 部 舵 机 CH8 、 右 脚 跨 部 舵 机 CH13 参 
数 ， 修 改 范 围 大 约 为 95 ~ 110 之 间 ， 使 机 器 人 重心 转移 到 右 腿 上 。 然 后 修改 左 腿 腿 部 各 舵 机 
CH9, CHI10, CHI1, CHI2 和 右 腿 腿 部 各 舵 机 CH14、CH15、CH16、CH17 参数 ， 使 机 器 人 
左 腿 抬 起 且 右 腿 能 够 作为 支撑 腿 保证 机 器 人 单 腿 站 立 而 不 倒 。 调 试 完 成 后 ， 单 击 “ 添 加 ” 
按钮 ， 将 这 一 帧 添加 到 数据 显示 区 域 中 ， 如 图 7-126 所 示 。 

3) 修改 左 腿 腿 部 各 舵 机 CH9, CH10, CH11, CH12 参数 ， 使 机 器 人 完成 “ 右 腿 不 动 ， 
左 脚 放 在 台阶 上 ”的 动作 ， 作 为 第 3 帧 数据 添加 到 数据 显示 区 域 ， 方 法 同上 。 

4) 修改 左 腿 跨 部 舵 机 CH8 、 右 脚 跨 部 舵 机 CH13 参数 ， 修 改 范围 大 约 为 70 ~ 85 之 间 ， 
使 机 器 人 重心 转移 到 左 腿 ， 并 修改 左 腿 腿 部 各 舵 机 CH9, CH10, CH11, CH12 和 右 腿 腿 部 
各 能 机 CH14, CH15, CH16, CH17 参数 , 令 机 器 人 完成 “重心 由 台阶 下 的 右 脚 转移 到 台阶 
上 的 左 脚 ” 的 动作 ， 作 为 第 4 帧 数据 添加 到 数据 显示 区 域 。 


186 


"Y ROBCON: 
dr EHE ”设置 帮助 
速度 控制 
eos eo oo og oa a | 


CHi 
Cue 


CH3 


CH4 


CHS 上 


CH3 


k 
k 
k 


LI 


| 插入 | ; 发 送 | 
文件 路 径 ap xen 


ch5 | cHe | cur | cHe | cro | cmo 
1 T8 90 5 50 


DATA | SPEED | CHi | CH? | aa CH4 
DATA 4 177 18T 84 90 I 


€ 


运行 复位 [usd 


图 7-125 设置 机 器 人 初始 位 置 为 候 楼 梯 动 作 第 一 帧 
"^ ROBCON 
文件 设 定 初始 位 置 设置 ERR 

速度 控制 ie 

k cCicezCcaeaCcsCcscT p 


«l| «l| «I 


THER (C: Documents and SettingsVWRol 关闭 串口 | 


序号 | DATA | SPEED | CHL | CH2 | CK3 | cha 


1 DATA 4 liT 157 84 90 
DATA 4 Frier amat 


ch | CHT | CH8 | CH9 | CH10 


T8 EU 54 50 
3n T 106 105 133 


当前 状态 pEjeiRHh cR MAE 


运行 | s | gm | 


图 7-126 — IIR SENE K EREE SER SS — pi 


187 


5) 修改 右 腿 腿 部 各 能 机 CHI4、CH15、CH16 CHI7 参数 ， 使 机 器 人 完成 “ 左 脚 不 动 ， 
台阶 下 的 右 脚 抬 起 ”的 动作 使 右 脚 离开 地 面 ， 整 个 机 器 人 由 台阶 上 的 左 腿 单独 支撑 。 将 调 
试 好 的 数据 作为 第 5 帧 数据 添加 到 数据 显示 区 域 。 

6) 修改 右 腿 腿 部 各 舵 机 CH14、CH15、CH16、CH17 参数 ， 使 机 器 人 完成 “将 已 抬 起 
的 右 脚 放 到 台阶 上 ”的 动作 ， 此 时 机 器 人 重心 仍 在 左 腿 上 ， 右 脚 轻 放 在 台阶 上 ， 不 作 支 撑 
机 器 人 重量 使 用 。 将 调试 好 的 数据 作为 第 6 帧 数据 添加 到 数据 显示 区 域 。 

7) 将 机 器 人 的 初始 位 置 ( 双 脚 直立 状态 ) 数据 ， 作 为 上 台阶 动作 的 第 7 帧 添加 到 数据 
显示 区 域 ， 方法 同 第 一 帧 数据 的 添加 方法 。 

调试 一 个 复杂 动作 的 过 程 就 是 上 面 的 一 个 过 程 。 

8) 我 们 在 调试 完整 个 分 解 过 程 后 ， 就 需要 把 这 些 分 解 后 的 动作 连 起 来 ， 也 就 是 我 们 把 
整个 一 组 数据 发 到 单片机 里 后 ， 看 看 效果 如 何 。 

首先 单 击 “ 发 送 ”按钮 ， 将 动作 数据 下 载 到 机 器 人 处 ， 然 后 单 击 “ 复 位 ”按钮 让 机 器 
人 先 复 位 到 初始 位 置 ， 最 后 单 击 “运行 "， 察 看 所 调试 的 完整 动作 。 

有 时 你 会 发 现 ， 单 个 动作 都 没有 问题 ， 但 连 起 来 会 出 问题 ， 也 就 是 衔接 不 好 。 这 可 能 是 
两 方面 的 原因 : 

(D 动作 分 解 得 不 够 细 ， 中 间 动 作 丢 失 ， 失 去 了 衔接 ; 

D 动作 速度 位 不 对 ， 比 如 由 一 组 动作 切 到 另 一 组 ， 由 于 速度 太 快 ， 机 器 人 有 惯性 ， 也 
会 失去 平衡 。 

在 这 种 情况 下 ， 继 续 细 调 数据 ， 使 之 更 好 地 衔接 并 使 速度 设置 更 合理 些 即 可 。 

同样 的 ， 有 时 由 于 动作 分 解 过 细 ， 也 会 出 现 很 多 元 余 帧 ， 使 数据 量变 大 。 实 际 上 没有 这 
些 数 据 ， 机 器 人 同样 可 以 很 好 地 完成 动作 ， 为 了 简单 化 ， 应 删 掉 多 余 的 数据 帧 。 

调试 过 程 中 ， 有 时 不 知道 该 给 每 个 舵 机 调 多 少 才能 到 达 某 种 状态 并 保持 平衡 ， 我 们 可 以 
采取 先 断 电 ， 用 手 把 机 器 人 扳 倒 那 种 状态 ， 大 概观 察 下 舵 机 的 位 置 ， 然 后 再 通电 ， 利 用 上 位 
机 同步 模式 来 拉动 滑 块 ， 使 舵 机 到 达 记 录 的 那 种 状态 ， 之 后 再 进行 细 调 。 

9) 调试 好 的 动作 ， 单 击 “ 保 存 ” 按 钮 ， 弹 出 如 图 7-127 所 示 对 话 框 ， 将 文件 名 设 定 为 

台阶 . dat”， 然 后 单 击 右边 的 “保存 ”按钮 。 

2. 让 机 器 人 执行 多 组 动作 

(1) 多 组 动作 发 送 ”多 动作 也 是 复杂 动作 的 一 种 ， 比 如 我 们 想 让 机 器 人 先 走路 ， 再 的 
楼 梯 ， 再 翻 跟 头等 等 ， 这 就 需要 我 们 事先 调试 好 这 些 单独 的 动作 ， 再 依次 发 到 单片机 里 ,我 
们 注意 到 上 位 机 程序 右上 角 有 个 组 号 ， 这 个 组 号 就 是 表示 数据 在 下 位 机 中 存放 的 区 域 ， 如 图 
7-128 圈 中 标注 所 示 。 

1) 先 向 单片机 里 发 送 第 一 组 数据 : 走路 。 方 法 如 下 : 单 击 “浏览 ”， 选 择 已 经 保存 好 
的 走路 数据 ， 之 后 单 击 “ 打 开 ” 按 钮 ， 如 图 7-129 所 示 。 

2) 然后 单 击 “ 发 送 ”按钮 ， 将 走路 数据 发 送 到 下 位 机 第 0 号 数据 存储 区 域 中 。 

3) 同上 述 步 又 ， 再 向 下 位 机 第 1 号 动作 存储 区 域 中 发 送 候 楼 梯 数 据 。 唯 一 不 同 的 是 在 
单 击 “ 发 送 ” 按 钮 之 前 ， 要 把 组 号 框 中 的 “0” 改 成 “1”， 之 后 再 单 击 “发 送 ” 以 后 各 动 
作 以 此 类 推 ， 均 发 送 到 不 同 的 指定 区 域 中 。 如 果 不 改组 号 ， 则 存储 区 域 中 的 数据 将 被 新 发 送 
过 来 的 数据 所 覆盖 ， 以 最 后 一 次 发 送 的 动作 为 准 。 


188 


T roncon — i- | - [x 
速度 控制 S 重复 ID 
M cicacaseacscecs p d EJ 


PEREST 
BEE: [O 机 器 人 动作 数据 


TE QD: 上 台阶 . dat 
TRÆ (T): [DAT Files (*. DAT) 


当前 状态 | 数据 读 职 完成 ”传送 进度 发 送 


运行 | se| ww | 退出 
图 7-127 保存 已 调试 好 的 机 器 人 动作 数据 


EH aAA 


文件 ” 设 定 初始 位 置 设置 帮助 


速度 控制 组 号 mu ID 
kK racersescscsch D 1 fer 


vor [m «| Je wesh «| H 
ac M HESSE iH Ei 
|vos 4 | 中 worpe «| | »| 
|m cu po a | 

| m om hm « ^| weous[or «| iil >| 
| m cma fios « p| memalis «| H >| 
| iv cmo [ss 4 | | wous[os «| 各 | 
|von «| | »| | weom[fz «| —$| B 
[v mef «| uj o| ror «| | >| 
Da] ][x M] e ] [让 


次 件 足 径 fe: \Documents and Settings\Rol EA 保存 关闭 串口 


序号 | DATA | speen | cii | cie | cH3 | cha | cus | cue | cur | cHe | cha | chio 


1 DATA 4 177 157 84 90 1 1 T8 30 54 50 


DATA 和 EIST 90 78 106 . 105 


当前 状态 | 数据 读 职 充 成 ”传送 进度 发 送 
运行 | sm | 顺 计 | 退出 
图 7-128 ”上 位 机 软件 组 号 标注 
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SAPE XCRIE 
E: |O 机 器 人 动作 数据 了 | ct Ed- 


TFA OD: 走路 
GEPESESUS (T): [DAT Files(*. dat) 


图 7-129 打开 走路 数据 文件 


(2) 动作 组 编排 将 已 经 存储 到 机 
器 人 下 位 机 中 的 各 组 动作 ， 通 过 动作 组 
编排 方式 ， 以 我 们 所 需要 的 顺序 ， 控 制 
机 器 人 来 执行 。 比 如 我 们 存放 时 顺序 为 : 
1, Æ P8; 2, JE BE B6 3. BH ORG, 
4. VER; 5, fl fa 打 4; 6, dH F; 
7, $E3k; 8 、 俯 卧 撑 (注意; 走路 为 第 1 
套 动作 ， 其 存放 在 第 0 组 ， 即 组 号 为 0。 
依 此 类 推 ， 第 8 套 的 俯卧 撑 存放 在 第 7 组 
中 ,组 号 为 7)。 现 在 让 它 执行 6、 招手 一 
1、 走 路 7、 摇头 M4、 踢 球 。 方法 如 下 : 

1) 单 击 菜单 中 的 “设置 ”一 “动作 
顺序 ”， 弹 出 如 图 7-130 所 示 窗 口 。 

2) 依次 双击 左 侧 框 中 的 “动作 6”、 
“动作 1” “动作 7”、 “动作 4” 即 可 ， 
注意 左边 框 里 数据 的 变化 ， 右 下 角 的 重 
复 框 中 ， 填 人 “1” 如 图 7-131 所 示 。 

3) 编排 窗口 右面 1~4 区 域 中 对 应 
的 数据 为 6、1 、7、4， 然 后 单 击 “ 确 定 ”。 回 到 主 界面 ， 再 单 击 上 位 机 软件 下 部 的 “顺序 ” 
按钮 ， 机 器 人 即 可 按 要 求 依 次 执行 6、1、7、4 四 个 动作 。 


五 、 思 考题 


L 调试 出 一 个 复杂 动作 的 方法 有 哪些 ? 

答 : (1) 通过 已 经 有 的 机 器 人 录像 进行 动作 分 解 ， 单 个 调试 分 解 动作 ， 然 后 再 在 各 分 
解 动作 中 间 插 入 必要 的 衔接 动作 。 

(2) 不 加 电 自 己 将 机 絮 人 摆 成 所 调试 动作 中 关键 的 几 帧 ， 目 测 每 一 帧 中 各 个 舵 机 位 置 ， 
然后 加 电 修改 通 机 角度 ， 到 达 这 些 位 置 ， 最 后 再 在 中 间 插 入 必要 的 衔接 动作 。 

2. 如 何 发 送 多 组 数据 到 单片机 ? 

B: 修改 上 位 机 软件 中 的 数据 组 号 ， 然 后 一 组 组 发 送 即 可 。 


图 7-130 ”动作 执行 顺序 编排 窗口 未 进行 设置 
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zE T HE 


图 7-131 ”动作 执行 顺序 编排 窗口 设置 完成 


3. 怎样 让 机 器 人 按 设 定 的 动作 顺序 运行 动作 ? 
答 : 通过 动作 顺序 调试 设置 运行 “顺序 ” 即 可 。 


实验 十 二 ”语音 控制 程序 实验 


一 、 实 验 目的 


1) 掌握 双 足 步行 机 器 人 上 位 机 语音 控制 平台 的 安装 。 
2) 学 会 语音 控制 平台 的 设置 和 调试 。 

3) 应 用 机 器 人 语音 控制 平台 控制 机 器 人 完成 动作 。 
4) 编写 语音 识别 程序 ， 并 调试 。 


二 、 实 验 设备 


硬件 设备 : 

PC —f (要 求 : 内 存 : 256MB 及 以 上 、CPU: 1.8GHz, EFR: 独立 多 功能 声卡 、 麦 
w: 质量 中 上 等 的 麦克 ) 、 串 口 通信 线 、 双 足 步 行 机 器 人 一 台 、 充 电 电 池 一 块 、 语 音 识别 加 
密 狗 一 个 。 

软件 设备 : 

Windows2000/ NT/XP 或 以 上 版 本 操作 系统 、 语 音 识别 SDK (语音 识别 库 一 一 Mandarin _ 
8kHz3. 0, asrapi. dll, ASRAPL h, asrapi. lib) 、 语 音 识 别 加 密 狗 驱动 程序 、 语 音 合 成 服务 器 
系统 InterPhonic CN Rev1.0 版 。 


三 、 实 验 原理 与 说 明 


1. 语音 识别 原理 
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H 
语音 识别 分 为 预 处 理 、 特 征 提取 、 模 式 匹配 三 部 分 ， 如 图 7-132 所 示 。 


一 UY ESA Hl [E EH 
预 处 理 特征 提取 模式 识别 HERRER, 


图 7-132 语音 识别 算法 原理 框图 


不 同 的 语音 对 应 着 不 同 的 波形 ， 预 处 理 过 程 把 声音 转换 成 相应 的 波形 ， 特 征 提 取 模 块 提 
取 波 形 的 波长 ， 频 率 等 特征 ， 如 “招手 ”和 “下 足 ” 这 两 名 话 预 处 理 完 之 后 对 应 着 完全 不 
同 的 波形 , 根据 提取 的 特征 和 模型 库 中 的 模型 进行 匹配 ， 得 到 相应 的 文字 ， 这 样 就 完成 了 整 


个 语音 识别 的 过 程 。 


2. 双 足 机 器 人 语音 识别 功能 模块 


双 足 机 器 人 语音 识别 功能 模块 利用 语音 识别 产品 Pattek ASR SDK Æ Visual C ++ 6.0 环 


境 下 进行 开发 。 


模式 语音 ASR 是 国内 首届 一 指 的 整套 语音 识别 解决 方案 ,具备 中 文 、 英 文 等 多 种 语言 


的 连续 语音 识别 以 及 听写 功能 ， 适 合 于 开发 计算 机 、 电 
话 、 扔 和 人 式 终端 等 各 种 设备 上 的 语音 应 用 程序 。 

依托 中 国 科 学 院 自 动 化 研究 所 在 语音 识别 研究 上 二 十 
年 的 技术 积累 ，Pattek ASR 具有 易 用 性 强 ， 识 别 率 高 的 特 
点 。 用 户 无 须 进 行 训练 ， 引 擎 的 设计 已 经 保证 了 非特 定 人 
这 一 重要 特点 ; API 提供 的 管理 工具 可 以 使 得 用 户 可 以 自 
如 地 定义 自己 所 需 的 词 表 和 语法 ， 以 便 应 付 不 同 的 应 用 需 
求 。API 就 是 应 用 程序 编程 接口 。 它 是 能 用 来 操作 组 件 、 
应 用 程序 或 者 操作 系统 的 一 组 函数 。 典 型 的 情况 下 ，API 
由 一 个 或 多 个 提供 某 种 特殊 功能 的 DLL 组 成 。 (Java 中 有 
所 不 同 ， 但 大 同 小 异 ) DLL 是 一 个 文件 ， 其 中 包含 了 在 
Microsoft Windows 下 运行 的 任何 应 用 程序 都 可 调用 的 函数 。 
运行 时 ，DLL 中 的 函数 动态 地 链接 到 调用 它 的 应 用 程序 
中 。 无 论 有 多 少 应 用 程序 调用 DLL 中 的 某 个 函数 ， 在 磁盘 
上 只 有 一 个 文件 包含 该 函数 ， 且 只 在 它 调 入 内 存 时 才 创 建 
该 DLL。 

双 足 机 器 人 语音 识别 功能 模块 的 程序 流程 图 如 图 7-133 
所 示 。 


始 识 别 


调用 回调 函数 


图 7-133 ”语音 识别 模块 流程 图 
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3. 双 足 机 器 人 上 位 机 语音 识别 程序 框架 

在 程序 的 开始 ， 首 先 要 利用 SDK 提供 的 Asr ”SetSystemDir () 函数 设置 识别 引擎 工作 
的 系统 目录 ， 主 要 是 指定 声学 模型 所 在 的 目录 ， 然 后 利用 Asr _ Sysmit () 初始 化 语音 识别 
系统 。 

如 果 语 音 识别 系统 初始 化 成 功 ， 则 可 以 利用 Asr ”LinelInit (ResultProc) 本 数 来 创建 一 
个 识别 引擎 hLine， 并 指定 该 引擎 将 结果 识别 出 来 时 的 回调 函数 以 及 用 户 定义 数据 。 

在 本 文中 我 们 对 语音 识别 回调 函数 定义 为 

DWORD ResultProc( HASRLINE hLine, const PASR NOTIFY pNotify, DWORD dwUserDa- 
ta) ; 

其 中 pNouty 是 回调 通知 ， 它 的 结构 体 如 下 : 

typedef struct ASR _ NOTIFY 

| 

int NotifyType; 


int data; 

DWORD dwReserve; 

| 

ASR NOTIFY, * PASR NOTIFY; 

这 个 结构 在 回调 函数 中 返回 与 语音 以 及 语音 识别 结果 相关 的 数据 ， 其 中 NotifyType 为 通 
知 类 型 ， 包 括 : 

NOTIFY RESULT 1 ZARJA 

NOTIFY VOICE LEVEL 2 //PUEKA 

NOTIFY UTT BEGIN 3 ”// 一 句 话 开始 

NOTIFY UTT END 4 // 一 句 话 结束 

data; 当 NotifyType X NOTIFY VOICE LEVEL 时 ，data 表示 当前 录音 的 大 小 ，Notify- 
Type 为 其 他 值 时 ，data 无 意义 。 

dwReserve. 保留 ， 无 意义 。 

然后 我 们 创建 录音 回调 函数 ， 录 音 回 调 函 数 用 来 记录 语音 数据 形成 数据 问 件 ， 供 语音 识 
别 回调 函数 调用 。 录 音 回 调 函 数 如 下 : 

int cb( const char * pbuf，int size) 

| 

Asr  RecFillWaveBuffer( hLine , pbuf size ) ; 
return 0; 

| 

成 功 创建 一 个 识别 引 警 后， 利用 Asr “GrammarLoad () 子 数 来 导入 语法 规则 文件 中 的 
语法 规则 ， 并 对 语法 规则 进行 设置 。 语 法 规则 文件 可 以 由 用 户 按照 语法 规则 的 要 求 根 据 需要 
自己 编写 ， 语 音 识 别 所 需要 用 到 的 语法 规则 ， 遵 循 ABNF 范式 ( Augmented BNF), 兼容 
W3C 语法 定义 。 语 法 规则 的 结构 体 如 下 所 示 : 

typedef struct GRAMMAR ACTIVATE 

| 
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int nNum; 
char * szRuleName[ 100] ; 
| 
HASR GRAMMAR, * PHASR GRAMMAR; 
我 们 可 以 使 用 该 结构 来 设置 、 切 换 、 关 闭 识别 引擎 对 应 的 语法 规则 。 其 中 : nNum 是 语 
法 规则 的 数量 ; szRuleName 是 语法 规则 的 名 字 ， 一 个 语音 识别 引擎 可 以 设置 多 个 语法 规则 。 
成 功 导入 语法 规则 后 ， 我 们 利用 Asr ”GrammarActivate () PRIORE GBA, d ER 
Asr RecSetAutoWork (true) 函数 由 引擎 内 部 自动 采集 语音 数据 ， 然 后 调用 Asr SetParam 
O 函数 设置 录音 以 及 引擎 相关 的 参数 ， 最 后 调用 末 数 Asr RecStartX (hLine) 开始 自动 识 
别 。 
端点 检测 到 语音 大 于 系统 设置 的 起 始 话音 音量 并 进行 录音 ， 当 语音 小 于 设置 的 结束 音量 
停止 录音 。 语 音 识别 系统 对 语 首 进行 识别 ,通过 回调 函数 得 到 回调 通知 ， 利 用 Asr GetNBe- 
stResult () 函数 获得 识别 结果 。 
如 果 不 再 需要 语音 识别 ， 利 用 Asr RecStopX (hLine) 函数 停止 由 Asr ”RecStartX PAX 
开启 的 识别 任务 ,利用 Asr _ LineRelease (hLine) 函数 关闭 hLine 语音 识别 引擎 ， 并 且 释 放 
其 相关 的 资源 ， 利 用 Asr SysRelease () 函数 退出 系统 ， 清 除 识别 系统 申 请 的 资源 。 


四 、 实 验 步 又 


实验 (一 ) ”安装 语 音 控制 平台 

1) 安装 语音 合成 软件 InterPhonic CN Revl. 0 版 ,安装 iFlyTTS SDK， 安装 加 密 狗 配置 
程序 (在 安装 盘 中 ) 。 

2) 在 系统 DSN 里 注册 数据 源 ， 选 择 驱 动 Microsoft access driver ( *. mdb) 建立 数据 库 
ShuangZudb. mdb 。 具 体操 作 步 又 如 下 : 

打开 控制 面板 一 管理 工具 一 数据 源 (ODBC) 一 系统 DSN 一 添加 一 选择 Microsoft access 
driver ( *. mdb) ， 单 击 “ 完 成 ”后 一 在 数据 源 名 里 输入 dashendb ， 同 时 单 击 数据 库 “ 选 择 ” 
按钮 ， 在 目录 项 中 选择 相应 路 径 (如 D: \...... \ 语音 控制 实验 \ Data) 下 的 Shuang- 
Zudb. mdb ， 并 在 数据 库 名 的 编辑 框 中 填 人 ShuangZudb. mdb 即 可 。 

3) 把 串口 1 和 无 线 发 射 器 连接 起 来 。 

4) 插 上 传声器 ( 即 麦克 风 ) 。 

实验 (二 ) ”熟悉 语音 控制 平台 

1. 界面 设置 

打开 文件 “语音 控制 实验 ”一 “语音 控制 平台 ”一 RobotSoft. exe， 就 会 出 现 如 图 7-134 的 
主 界面 。 

菜单 栏 主要 包括 登录 选项 、 功 能 设置 、 界 面 设置 、 版 本 信息 、 退 出 (退出 密码 : 000), 

状态 栏 主要 包括 成 功 语音 识别 初始 化 信息 、 语 音 合成 初始 化 信息 、 视 频 初 始 化 信息 。 

当 用 户 对 着 话 简 按 照 界面 左 侧 移动 的 字幕 讲话 时 ， 如 : 一 号 跳 街舞 ， 通 过 语音 识别 就 可 
以 命令 机 器 人 做 各 种 动作 。 

注意 : 当 讲 完 话 后 机 器 人 没有 任何 反应 时 ， 可 能 有 两 个 原因 : 中 串口 不 一 致 。 解 决 方 
法 : 大 有 两 个 串口 ， 必 须 连 接 至 串口 1 上 ， 乔 因 特 殊 原 因 连 接 至 串口 2 上 ,打开 “语音 控制 


194 


CNET - - — - - — - 20x 


Is) 功能 设置 此) BEmRE(E) WERE EHE) 


pw HE ys 
E 7 fü 
W-z tg 


AUR 

lU ÉL 

Ad ER 
BEI 


^ EI UNE ZE dux 
LA E I 


» ` 
| ET 二 EE BUREUEMSO FS EF | 


图 7-134 ŁR E 


EPE” XR, HAXE “ComSet. ini”, H *nPort =1” 改 成 “npPort =2”， 之 后 保存 即 可 。 


@) 必 须 用 音效 较 好 的 传声器 ， 且 不 能 将 音量 控制 语音 识别 音量 设置 X, 
中 的 传声器 的 音量 调制 得 太 高 。 一 般 还 要 在 传 声 
器 的 “高 级 ”设置 里 将 “Mic Boost" 复 选 上 ， 有 EE. 


少数 情况 下 (如 计算 机 差异 的 原因 ) 不 能 复 选 。 > 

2. 识别 语音 设置 

打开 菜单 项 “登录 选项 " ub een, de 
弹出 的 对 话 框 中 输入 登录 密码 (000)， 单 击 “ 登 
E d 即 可 看 到 图 7-135, B 确定 取消 

系统 默认 得 起 始 音量 是 100， 最 高 音量 是 
300。 用 户 可 以 根据 需要 自由 设置 音量 大 小 (起 
全 音量 < 最 高 音量 ) ， 只 要 用 户 说 话 得 音量 在 这 ELEDA TERCER 
两 个 数值 之 间 ， 系 统 都 能 成 功 识别 。 

实验 (三) ”编程 实现 语音 识别 模块 

1) 编写 语音 识别 模块 VC 控制 平台 程序 。 

打开 Microsoft Visual C ++ 6.0， 新 建 一 个 工程 选 Win32 Console Application ， 工 程 名 可 
写 为 “Yysb”，Location 可 以 根据 需要 自己 设 定 ， 单 击 OK, 选择 “A ‘Hello, World!’ appli- 
cation. ”， 然 后 单 击 “Finish”， 单 击 “OK”。 单 击 工作 区 中 的 Class view 选项 卡 中 的 Yysb 
classes 前 的 “+”， 再 单 击 Globals 前 的 “+ ”， 然 后 双击 Globals 中 的 成 员 函 数 。 然 后 在 右 
边 的 代码 编辑 器 中 ,将 注释 号 “//” 下 面 的 内 容 删除 掉 ， 然 后 编写 语音 识别 模块 VC 控制 平 
台 程序 。 
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语音 识别 模块 VC 控制 平台 程序 示例 : 
#include " stdafx. h " 
sinclude " stdio. h " 
sinclude " iostream. h " 
include " asrapi. h " 
sinclude " windows. h " 
#define ONLINE TEST 
HASRLINE hLine ; 
// 录 音 回调 函数 
int cb( const char * pbuf, int size) 
| 
Asr RecFillWaveBuffer( hLine , pbuf , size ) ; 


return 0; 


| 
// 语 音 识 别 回调 函数 
DWORD ResultProc (HASRLINE hLine, const PASR NOTIFY pNotify, DWORD dwUserDa- 


ta) 


switch ( pNotify — > NotifyType) 
| 


case NOTIFY UTT BEGIN: 
break ; 

case NOTIFY UTT END: 
break ; 

case NOTIFY VOICE LEVEL; 
break ; 

case NOTIFY RESULT: 


int count ; 
char * * result; 
int * confidence; 
Asr GetNBestResult (hLine,count, result , confidence) ; 
if(count == 0) 
printf( " 拒 识 \n ") ; 
else 
| 
for(inti 20; i< 1; i++) 


| 
printf("\r% dth: %s\n", i+1, result[i]) ; 
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| 
#ifdef ONLINE TEST 


printf ( "请 继续 说 话 推出 请 按 ' q' \n\n'"); 
Asr RecStart(hLine,RAW LINEAR PCM 16BIT); 


#else 
printf( "推出 请 按 'q' \n\n”); 
#endif 
break; 
| 
return OL; 
| 
main( ) 


| 
cout << " Begin " << endl; 
Asr SetSystemDir(". /Mandarin. 8KHz3. 0 ") ; 
int nRet = Asr Syslnit( ) ; 
if( nRet) 
| 
cout << "init error " << endl; 
return 1; 
| 
else 


cout << " init success " << endl; 


// 生 成 一 个 识别 引擎 
hLine = Asr Linelnit( ResultProc ) ; 
if( ! hLine) 
| 
cout <<" Engine Create Failed " << endl; 


return 1; 


| 


else 


cout << "engine create success " «« endl ; 


nRet = Asr GrammarLoad ( hLine," test. grm ", CHARACTER _ GB," test. lec ") ; 


if( nRet) 
| 
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cout << " gramload failed " << endl; 
return 1; 

| 

else 


cout <<" gramload success " << endl; 


// 激 活 语 法 规则 
nRet = Asr GrammarActivate (hLine," talk ") ; 
if( nRet) 


| 


cout <<" Grammar Activate Failed " << endl; 
Asr LineRelease( hLine) ; 
Asr SysRelease () ; 
return 1; 
| 
else 


cout << " grammar activate success " << endl; 


Asr  SetLog( hLine ,false) ; 
#ifdef ONLINE TEST 
Asr _ RecordOpen( ) ; /打开 录音 设备 ， 
Asr RecStatt(hLine,RAW LINEAR PCM  16BIT) ; // 开 始 识别 
Asr RecordStart(cb); // 开 始 录音 
#endif 


while(1) 
| 
Sleep(100) ; 
char command |[2 ] ; 
scanf( "96 s ", command ) ; 
if(stremp( | strlwr( command) ," q ") 220) 
break ; 


#ifdef ONLINE _ TEST 

Asr _ RecordStop( ) ; // 停 止 录音 

Asr RecordClose();  // 关 闭 录 音 设 备 
#endif 

Asr LineRelease( hLine) ; 
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Asr SysRelease( ) ; 
return 0; 

| 

2) 编写 语法 规则 。 新 建 一 个 记事 本 命名 为 test. grm ,在 里 面 写 人: 

$talk = (* * *1l...)«0- > $talks( * * *1...) «0- »; 

$ talks = 

你 好 | 

你 会 唱歌 吗 | 

你 多 大 了 ; 

注 : test. grm 文件 增加 语法 的 规则 : Æ “$ talks = ”后 面 增加 要 识别 的 语句 ， 则 需 另 起 
一 行 并 且 顶 行 开 始 以 “1 ”结尾 ， 每 一 条 语句 为 一 行 ， 文 件 的 最 后 一 条 语句 以 “;” 结 尾 。 
否则 不 能 进行 识别 ! 

然后 再 新 建 一 个 记事 本 命名 为 test. lec, test. lec 是 注音 文件 ， 其 中 第 一 行 的 数字 是 要 注 
音 的 语句 的 个 数 。 在 里 面 写 人: 

3 

你 好 ni3 hao3 

你 会 唱歌 吗 ni3 hui4 chang4 gel mal 

你 多 大 了 ni3 duo2 da4 lel 

3) 把 Mandarin _ 8KHz3. 0, asrapi. dll, ASRAPI. h, asrapi. lib (D: V...... V 语音 控制 
实验 \ 所 需 复 制 的 文件 \ bin 中 ) , test. gm, test. lec 文件 复制 到 当前 程序 所 在 的 目录 下 。 

4) 打开 VC ++6.0 建立 的 语音 识别 控制 台 程 序 ， 设 置 link 库 文 件 : 打开 工程 (project) 
菜单 — > setting… 打 开工 程 设置 (project setting) 对 话 框 ， 选 择 link 选项 卡 ， 在 object/library 
modules 编辑 框 中 添加 asrapi. lib. (Œ: 如 果 有 多 个 link 库 文件 ， 文 件 之 间 要 用 空格 隔 开 )， 
单 击 OK 。 

5) 在 工程 中 加 入 ASRAPI. h 文件 : 单 击 工作 区 中 的 file view 选项 卡 ， 右 击 Header Files 
- > Add files to folder… 打 开 选 择 文件 对 话 框 选中 ASRAPL h 文件 ， 单 击 确定 。 

6) 最 后 对 程序 进行 编译 和 运行 ， 就 会 出 现 如 图 7-135 的 界面 ， 然 后 对 着 传声器 说 你 好 、 
你 会 唱歌 吗 ， 你 多 大 了 ， 即 可 以 识别 ， 若 要 增加 识别 语句 ， 可 以 在 遵循 语法 规则 在 test. gm 
文件 和 test. lec 文件 里 增加 。 


五 、 思 考题 


1. 简 述 语音 识别 的 原理 ， 并 想象 语音 识别 在 现实 中 可 应 用 在 哪些 方面 ? 

答 : 语音 识别 分 为 预 处 理 、 特 征 提 取 、 模 式 匹配 三 部 分 。 预 处 理 过 程 把 声音 转换 成 相应 
的 波形 ， 特 征 提取 模块 提取 波形 的 波长 ， 频 率 等 特征 ， 根 据 提取 的 特征 和 模型 库 中 的 模型 进 
行 匹配 ， 得 到 相应 的 文字 ， 这 样 就 完成 了 整个 语音 识别 的 过 程 。 语 音 识别 适合 于 开发 计算 
机 、 电 话 、 授 入 式 终端 等 各 种 设备 上 的 语音 应 用 程序 。 

2. 利用 编 好 的 语音 识别 模块 ， 使 之 能 够 和 使 用 者 进行 简单 的 语音 互动 ， 如 编写 一 个 记 
事 本 程序 用 语音 控制 字符 的 输出 等 。( 选 做 ) 

如 图 7-136 所 示 为 语音 识别 模块 VC 控制 平台 运行 结 
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init success 
engine create success 


gramload success 
grammar activate success 


图 7-136 语音 识别 模块 VC 控制 平台 程序 运行 结果 


语音 识别 模块 函数 详细 说 明 : 
Asr SetSystemDir 
ASRERROR ASR  API Asr SetSystemDir( const char * psDir ; 
psDir， 声学 模型 所 在 的 目录 。 
e 输出 参数 . 


无 。 
e 返回 值 : 

返回 错误 码 ，ASRERROR . OK 表明 操作 成 功 。 
e 描述 . 


设置 识别 引擎 工作 的 系统 目录 ， 主 要 是 指 声学 模型 所 在 的 目录 。 在 调用 
初始 化 函数 Asr . Syslnit 之 前 应 该 先 调用 此 函数 。 
Asr Syslnit () 
ASRERROR ASR _ API Asr Syslnit( const char * sInCfgFileName = NULL) ; 
e 输入 参数 : 
sInCfgFileName: 资源 配置 文件 名 ; 默认 为 NULL。 
。 输出 参数 : 
无 。 
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返回 值 : 
返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
描述 : 


识别 系统 的 初始 化 函数 。 


Asr Linelnit (ResultProc ) 


函数 原型 ; 

HASRLINE ASR _ API Asr Linelnit( FNRESULTNOTIFY fnNotify, DWORD 
dwUserData = NULL); 

输入 参数 ， 

fnNotify: 回调 函数 ， 识 别 结果 等 信息 通过 此 函数 返回 给 用 户 ， 详 见 结构 
说 明 。 

DwUserData: 用 户 自 定义 数据 。 

输出 参数 : 

无 

返回 值 : 

引擎 句柄 ， 详 见 结构 说 明 

描述 : 

创建 一 个 语音 识别 引擎 ， 并 指定 该 引擎 识别 结果 出 来 时 的 回调 函数 以 及 
用 户 定义 数据 。 


Asr Grammarload () 


函数 原型 : 

ASRERROR ASR API Asr _ GrammarLoad( HASRLINE hAsrLine const char 
* s[InGrammarFileName, int nCode = CHARACTER _ GB const char * szLexi- 
conName = NULL); 

输入 参数 ， 

hAsrLine; 识别 引擎 的 句柄 ， 由 引擎 初 始 化 函数 Asr . Linelnit 得 到 。 
sInGrammarFileName; 语法 规则 文件 名 。 

nCode: 字符 编码 ， 默 认为 CB2312 。 

szLexiconName; 注音 文件 名 。 


输出 参数 : 

无 。 

返回 值 ; 

返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
描述 : 


导入 语法 规则 文件 中 的 语法 规则 。 如 果 语 法 中 有 非 标 准 发 音字 符 或 者 多 
音字 ， 可 以 在 第 二 个 参数 中 提供 注音 文件 ， 这 个 文件 是 文本 文件 ， 第 一 
行为 符号 个 数 ， 以 后 每 行为 一 个 词 或 者 符号 ， 然 后 是 空格 ,后 面 接 发 音 ， 
多 个 发 音 之 间 用 “1 ”分 隔 。 当 这 个 参数 为 空 时 ， 将 尝试 查找 和 语法 规 
则 文件 名 相同 ， 后 组 为 “lec” 的 文件 。 注 音 规 则 是 : 如 果 注 音 文件 里 提 
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供 ， 直 接 采 用 注音 文件 里 的 发 音 ， 和 否则 尝试 自动 注音 ， 自 动 注音 失败 将 
返回 错误 。 


Asr GrammarActivate 


Asr _ RecStart 


Asr SetParam 


函数 原型 ; 

ASRERROR ASR _ API Asr GrammarActivate( HASRLINE hInAsrLine, const 
char * pGrammar) ; 

输入 参数 ， 

hAsrLine; 识别 引擎 的 句柄 ， 由 引擎 初 始 化 函数 得 到 。 

pGrammar; 语法 规则 名 。 


输出 参数 ， 

无 。 

返回 值 ; 

返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
描述 : 


设置 识别 引擎 的 语法 规则 。 必 须 首 先 使 用 Asr GrammarLoad 或 Asr — 
GrammarLoadFromBuffer 函数 载 人 到 系统 中 。 


函数 原型 : 

ASRERROR ASR _ API Asr RecStart( HASRLINE hInAsrLine, int nWave- 
Format) ; 

输入 参数 ， 

hAsrLine; 识别 引擎 的 句柄 ， 由 引擎 初 始 化 函数 得 到 。 
CWaveFormat: 待 识别 语音 的 格式 ， 见 头 文件 定义 。 

输出 参数 : 

无 。 

返回 值 : 

返回 错误 码 ，ASRERROR _ OK 表明 操作 成 功 。 

描述 : 

在 这 一 识别 引擎 中 开始 等 待 填充 语音 数据 进行 识别 。 调 用 此 函数 必须 编 
写 程序 采集 语音 数据 ， 接 着 调用 Asr . RecFillWaveBuffer 填充 语音 数据 。 
当 数 据 足 够 产生 结果 的 时 候 引 苟 将 会 自动 结束 并 返回 结果 。 如 果 数 据 已 
经 全 部 输入 还 没有 得 到 结果 ,或 者 想 立 即 得 到 结果 ， 可 以 调用 Asr _ Rec- 
stop 主动 结束 并 返回 结 


函数 原型 : 

ASRERROR ASR _ API Asr SetParam (HASRLINE hInAsrLine , int type, 
DWORD data) ; 

输入 参数 : 

Type: 设置 参数 的 类 型 。 


202 


Asr RecStart 


Data; 参数 的 值 。 

输出 参数 : 

无 。 

返回 值 ; 

返回 错误 码 ，ASRERROR _ OK 表明 操作 成 功 。 

描述 : 

设置 录音 以 及 引擎 相关 的 参数 ，type 取 值 以 及 含义 如 下 : 

5. 是 否 连续 录音 识别 。 如 果 为 1 表示 连续 的 录音 和 反馈 识别 结果 ， 中 间 
不 需要 干预 。 如 果 为 0 表示 每 次 识别 出 一 个 结果 后 将 停止 录音 ,需要 再 
次 调用 Asr RecStartX 才能 进行 下 一 次 识别 。 

8: 设置 在 录音 的 时 候 是 否 检测 前 端点 ， 如 果 不 进 行 前 端点 检测 ， 将 从 调 
用 Asr RecStattX 之 后 ， 认 为 所 有 的 声音 都 为 说 话 声 ， 录 音 数 据 送 入 识 
别 引 擎 进行 识别 。 

Data 不 为 0 表示 不 进行 端点 检测 ，0 为 端点 检测 。 默 认为 进行 端点 检测 。 
9. 是 否 进行 尾 端点 检测 。 在 检测 前 端点 的 前 提 下 ， 可 以 进一步 决定 是 否 
进行 尾 端点 检测 。 如 果 进 行 尾 端点 检测 ， 在 开始 说 话 后 停顿 一 定 的 时 间 
就 认为 该 句 话 结 束 ， 停 顿时 间 由 本 函数 type 为 13 设 定 。 

10; 起 始 话 音 音量 , 默认 为 100。 

11; 说 话 结束 音量 , 默认 为 300。 

12: 起 始 话音 长 度 ， 如 果 超 过 这 个 时 间 ， 认 为 说 话 开始 ， 单 位 为 毫秒 ， 
默认 为 120。 

13. 词 之 间 最 长 停顿 时 间 ， 如 果 超 过 这 个 时 间 ， 将 视 为 说 话 结束 ， 单 位 
为 毫秒 ， 默 认为 360。 

15, 设置 录音 长 度 ， 一 旦 录音 超出 这 个 时 间 ， 将 强制 结束 并 识别 ， 单 位 


为 毫秒 。 


函数 原型 : 

ASRERROR ASR _ API Asr RecStart( HASRLINE hInAsrLine, int nWave- 
Format ) ; 

输入 参数 ， 

hAsrLine; 识别 引 警 的 句柄 ， 由 引擎 初 始 化 函数 得 到 。 

CWaveFormat; 待 识别 语音 的 格式 ， 见 头 文 件 定 义 。 

输出 参数 : 

无 。 

返回 值 : 

返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 

描述 : 

在 这 一 识别 引擎 中 开始 等 待 填充 语音 数据 进行 识别 。 调 用 此 函数 必须 编 
写 程序 采集 语音 数据 ， 接 着 调用 Asr . RecFillWaveBuffer 填充 语音 数据 。 
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当 数 据 足够 产生 结果 的 时 候 引 擎 将 会 自动 结束 并 返回 结果 。 如 果 数 据 已 
经 全 部 输入 还 没有 得 到 结果 ， 或 者 想 立 即 得 到 结果 ， 可 以 调用 Asr . Rec- 
Stop 主动 结束 并 返回 结果 。 


Asr GetNBestResult ( ) 


Asr RecStop 


函数 原型 ; 

HASRLINE hAsrLine, int& nCount, char * * & result, int * & Confidence 
HASH: 

hAsrLine; 识别 引擎 的 句柄 ， 由 引擎 初 始 化 函数 得 到 。 

nCount: 根据 打分 由 高 到 低能 够 获取 的 识别 结果 的 个 数 。 

Result. 识别 结果 字符 串 指针 。 由 result [0] 到 result [ nCount] 依次 为 
最 好 的 结果 ， 次 好 的 结果 等 。 

Confidence: 识别 结果 打分 。 由 result [0] 到 result [ nCount] 依次 为 最 
高 分 ， 次 高 分 。 


输出 参数 : 

无 。 

返回 值 ; 

返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
描述 : 


获取 按照 准确 度 排 序 的 识别 结果 以 及 打分 。 参 数 内 存 分 配 和 释放 由 sdk 
内 部 维护 。 


函数 原型 : 

ASRERROR ASR _ API Asr RecStop( HASRLINE hInAsrLine ) ; 
输入 参数 ， 

hAsrLine; 识别 引擎 的 句柄 ， 由 引擎 初 始 化 函数 得 到 。 


输出 参数 ， 

无 。 

返回 值 ; 

返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
描述 : 


停止 这 一 个 引擎 的 识别 任务 ， 可 以 在 Asr “RecStart 函数 执行 后 任何 时 候 
执行 此 函数 ， 此 函数 执行 后 要 再 次 识别 时 需 重新 调用 Asr RecStart 函数 。 


Asr LineRelease (hLine) 


函数 原型 : 

ASRERROR Asr LineRelease (HASRLINE hAsrLine) 

输入 参数 ， 

hAsrLine; 识别 引擎 的 句柄 由 引擎 初始 化 函数 Asr . Linelnit 得 到 。 
输出 参数 : 

无 。 
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. 返回 值 . 
返回 错误 码 ，ASRERROR OK 表明 操作 成 功 。 
e 描述 . 


关闭 这 一 个 语音 识别 引擎 ， 并 且 释 放 其 相关 的 资源 。 
Asr  SysRelease () 
ASRERROR ASR _ API Asr SysRelease( ) ; 
e 输入 参数 . 
无 。 
。 输出 参数 . 
无 。 
e 返回 值 : 
返回 错误 码 ，ASRERROR _ OK 表明 操作 成 功 。 
e 描述 : 
系统 退出 时 调用 ， 清 除 识别 系统 申请 的 资源 。 
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